add ipq60xx

root/include/kernel-version.mk

@@ -6,12 +6,12 @@ ifdef CONFIG_TESTING_KERNEL
   KERNEL_PATCHVER:=$(KERNEL_TESTING_PATCHVER)
 endif
 
-LINUX_VERSION-5.4 = .182
+LINUX_VERSION-5.4 = .164
 LINUX_VERSION-5.10 = .64
 LINUX_VERSION-5.14 = .6
 LINUX_VERSION-5.15 = .36
 
-LINUX_KERNEL_HASH-5.4.132 = 8466adbfb3579e751ede683496df7bb20f258b5f882250f3dd82be63736d00ef
+LINUX_KERNEL_HASH-5.4.164 = 2d692089dfd02e238d2164f8a599db21e04dab8d4e291c3ccbd863bcd5b00e6a
 LINUX_KERNEL_HASH-5.4.182 = b2f1201f64f010e9e3c85d6f303a559a7944a80a0244a86b8f5035bd23f1f40d
 LINUX_KERNEL_HASH-5.10.64 = 3eb84bd24a2de2b4749314e34597c02401c5d6831b055ed5224adb405c35e30a
 LINUX_KERNEL_HASH-5.14.6 = 54848c1268771ee3515e4c33e29abc3f1fa90d8144894cce6d0ebc3b158bccec

root/include/target.mk

@@ -148,10 +148,17 @@ ifneq ($(TARGET_BUILD)$(if $(DUMP),,1),)
 endif
 
 GENERIC_PLATFORM_DIR := $(TOPDIR)/target/linux/generic
+ifeq ($(CONFIG_TARGET_ipq60xx),y)
+GENERIC_BACKPORT_DIR :=
+GENERIC_PATCH_DIR :=
+GENERIC_HACK_DIR :=
+GENERIC_FILES_DIR :=
+else
 GENERIC_BACKPORT_DIR := $(GENERIC_PLATFORM_DIR)/backport$(if $(wildcard $(GENERIC_PLATFORM_DIR)/backport-$(KERNEL_PATCHVER)),-$(KERNEL_PATCHVER))
 GENERIC_PATCH_DIR := $(GENERIC_PLATFORM_DIR)/pending$(if $(wildcard $(GENERIC_PLATFORM_DIR)/pending-$(KERNEL_PATCHVER)),-$(KERNEL_PATCHVER))
 GENERIC_HACK_DIR := $(GENERIC_PLATFORM_DIR)/hack$(if $(wildcard $(GENERIC_PLATFORM_DIR)/hack-$(KERNEL_PATCHVER)),-$(KERNEL_PATCHVER))
 GENERIC_FILES_DIR := $(foreach dir,$(wildcard $(GENERIC_PLATFORM_DIR)/files $(GENERIC_PLATFORM_DIR)/files-$(KERNEL_PATCHVER)),"$(dir)")
+endif
 
 __config_name_list = $(1)/config-$(KERNEL_PATCHVER) $(1)/config-default
 __config_list = $(firstword $(wildcard $(call __config_name_list,$(1))))
@@ -243,6 +250,7 @@ ifeq ($(DUMP),1)
   endif
   ifeq ($(ARCH),aarch64)
     CPU_TYPE ?= generic
+    CPU_CFLAGS += -march=armv8-a+crypto
     CPU_CFLAGS_generic = -mcpu=generic
     CPU_CFLAGS_cortex-a53 = -mcpu=cortex-a53
   endif

root/package/boot/uboot-envtools/files/ipq60xx

@@ -0,0 +1,39 @@
+#!/bin/sh
+
+[ -e /etc/config/ubootenv ] && exit 0
+
+touch /etc/config/ubootenv
+
+. /lib/uboot-envtools.sh
+. /lib/functions.sh
+
+board=$(board_name)
+
+ubootenv_mtdinfo () {
+	UBOOTENV_PART=$(cat /proc/mtd | grep APPSBLENV)
+	mtd_dev=$(echo $UBOOTENV_PART | awk '{print $1}' | sed 's/:$//')
+	mtd_size=$(echo $UBOOTENV_PART | awk '{print "0x"$2}')
+	mtd_erase=$(echo $UBOOTENV_PART | awk '{print "0x"$3}')
+	nor_flash=$(find /sys/bus/spi/devices/*/mtd -name ${mtd_dev})
+
+	if [ -n "$nor_flash" ]; then
+		ubootenv_size=$mtd_size
+	else
+		# size is fixed to 0x40000 in u-boot
+		ubootenv_size=0x40000
+	fi
+
+	sectors=$(( $ubootenv_size / $mtd_erase ))
+	echo /dev/$mtd_dev 0x0 $ubootenv_size $mtd_erase $sectors
+}
+
+case "$board" in
+*)
+	ubootenv_add_uci_config $(ubootenv_mtdinfo)
+	;;
+esac
+
+config_load ubootenv
+config_foreach ubootenv_add_app_config ubootenv
+
+exit 0

root/package/link4all/ath11k-firmware/Makefile

@@ -0,0 +1,66 @@
+#
+# Copyright (C) 2021 OpenWrt.org
+#
+# This is free software, licensed under the GNU General Public License v2.
+# See /LICENSE for more information.
+#
+
+include $(TOPDIR)/rules.mk
+
+PKG_NAME:=ath11k-firmware
+PKG_SOURCE_DATE:=2021-07-20
+PKG_SOURCE_VERSION:=d4003c1921810adcc455d46f17776a3392b29436
+PKG_MIRROR_HASH:=6839081bafbc56d3b8e41d30790b20813c349cbc1732e887347ef5ed3ea717e4
+PKG_RELEASE:=1
+
+PKG_SOURCE_PROTO:=git
+PKG_SOURCE_URL:=https://github.com/kvalo/ath11k-firmware.git
+
+PKG_MAINTAINER:=Robert Marko <robimarko@gmail.com>
+
+include $(INCLUDE_DIR)/package.mk
+
+define Package/ath11k-firmware-default
+  SECTION:=firmware
+  CATEGORY:=LINK4ALL
+  URL:=$(PKG_SOURCE_URL)
+  DEPENDS:=
+endef
+
+define Package/ath11k-firmware-ipq6018
+$(Package/ath11k-firmware-default)
+  TITLE:=ath11k firmware for IPQ6018 devices
+endef
+
+define Package/ath11k-firmware-ipq8074
+$(Package/ath11k-firmware-default)
+  TITLE:=ath11k firmware for IPQ8074 devices
+endef
+
+define Build/Compile
+	true
+endef
+
+define Package/ath11k-firmware-ipq6018/install
+	$(INSTALL_DIR) $(1)/lib/firmware/ath11k/IPQ6018/hw1.0
+	$(INSTALL_DIR) $(1)/lib/firmware/IPQ6018
+	$(INSTALL_DATA) \
+		$(PKG_BUILD_DIR)/IPQ6018/hw1.0/2.5.0.1/WLAN.HK.2.5.0.1-01100-QCAHKSWPL_SILICONZ-1/* \
+		$(1)/lib/firmware/IPQ6018/
+	$(INSTALL_DATA) ./files/board-2.bin.IPQ6018 \
+		$(1)/lib/firmware/ath11k/IPQ6018/hw1.0/board-2.bin
+endef
+
+define Package/ath11k-firmware-ipq8074/install
+	$(INSTALL_DIR) $(1)/lib/firmware/ath11k/IPQ8074/hw2.0
+	$(INSTALL_DIR) $(1)/lib/firmware/IPQ8074
+	$(INSTALL_DATA) \
+		$(PKG_BUILD_DIR)/IPQ8074/hw2.0/board-2.bin \
+		$(1)/lib/firmware/ath11k/IPQ8074/hw2.0/
+	$(INSTALL_DATA) \
+		$(PKG_BUILD_DIR)/IPQ8074/hw2.0/2.5.0.1/WLAN.HK.2.5.0.1-01100-QCAHKSWPL_SILICONZ-1/* \
+		$(1)/lib/firmware/IPQ8074/
+endef
+
+$(eval $(call BuildPackage,ath11k-firmware-ipq6018))
+$(eval $(call BuildPackage,ath11k-firmware-ipq8074))

root/package/link4all/ch342/Makefile

@@ -0,0 +1,45 @@
+#
+# Copyright (c) 2014 The Linux Foundation. All rights reserved.
+#
+
+include $(TOPDIR)/rules.mk
+include $(INCLUDE_DIR)/kernel.mk
+
+PKG_NAME:=usb-serial-ch343
+PKG_VERSION:=2022-03-01-1026
+PKG_RELEASE:=1
+
+
+PKG_BUILD_DIR:=$(KERNEL_BUILD_DIR)/$(PKG_NAME)
+
+include $(INCLUDE_DIR)/package.mk
+
+define KernelPackage/usb-serial-ch343
+  SUBMENU:=USB Support
+  DEPENDS:=+kmod-usb-serial
+  TITLE:=Kernel USB driver for ch342/3
+  FILES:= $(PKG_BUILD_DIR)/ch343.ko
+  AUTOLOAD:=$(call AutoLoad,81,ch343)
+endef
+
+define KernelPackage/usb-serial-ch343/Description
+This package contains a USB driver for ch343
+endef
+
+define Build/Prepare
+	$(CP) src/* $(PKG_BUILD_DIR)
+	$(call Build/Prepare/Default)
+endef
+
+MAKE_OPTS:= \
+	$(KERNEL_MAKE_FLAGS) \
+	M="$(PKG_BUILD_DIR)"
+
+define Build/Compile
+	$(MAKE) -C "$(LINUX_DIR)" \
+		$(MAKE_OPTS) \
+		modules
+endef
+
+$(eval $(call KernelPackage,usb-serial-ch343))
+

root/package/link4all/ch342/src/Makefile

@@ -0,0 +1,3 @@
+obj-m += ch343.o
+
+

root/package/link4all/ch342/src/ch343.h

@@ -0,0 +1,230 @@
+/*
+ *
+ * Includes for ch343.c
+ *
+ */
+
+/*
+ * Baud rate and default timeout
+ */
+#define DEFAULT_BAUD_RATE 9600
+#define DEFAULT_TIMEOUT   2000
+
+/*
+ * CMSPAR, some architectures can't have space and mark parity.
+ */
+
+#ifndef CMSPAR
+#define CMSPAR			0
+#endif
+
+/*
+ * Major and minor numbers.
+ */
+
+#define CH34X_TTY_MAJOR		168
+#define CH34X_TTY_MINORS	256
+
+/*
+ * Requests.
+ */
+
+#define USB_RT_CH34X		(USB_TYPE_CLASS | USB_RECIP_INTERFACE)
+
+//Vendor define
+#define VENDOR_WRITE_TYPE		0x40
+#define VENDOR_READ_TYPE		0xC0
+
+#define VENDOR_READ				0x95
+#define VENDOR_WRITE			0x9A
+#define VENDOR_SERIAL_INIT		0xA1
+#define VENDOR_MODEM_OUT		0xA4
+#define VENDOR_MODEM_IN			0x05
+#define VENDOR_GPIO				0xA8
+#define VENDOR_DELAY_MS			0x5E
+#define VENDOR_VERSION			0x5F
+#define VENDOR_GPIO_EN1			0xAA
+#define VENDOR_GPIO_EN2			0xAC
+#define VENDOR_GPIO_SET			0xAB
+#define VENDOR_GPIO_GET			0xA9
+
+
+/*
+ * Output control lines.
+ */
+#define CH34X_CTRL_OUT		0x10
+#define CH34X_CTRL_DTR		0x20
+#define	CH34X_CTRL_RTS		0x40
+#define	CH34X_CTRL_AFE		0x80
+
+/******************************/
+/* interrupt pipe definitions */
+/******************************/
+/* first irq byte indicates type */
+/* second irq byte indicates modemA */
+/* third irq byte indicates modemB */
+
+/*
+ * status returned in third interrupt answer byte,
+ * inverted in data from irq
+ */
+#define CH34X_CTRL_CTS		0x01
+#define CH34X_CTRL_DSR		0x02
+#define CH34X_CTRL_RI		0x04
+#define CH34X_CTRL_DCD		0x08
+#define CH34X_MODEM_STAT 	0x0f
+
+#define CH34X_CTRL_TYPE_MODEM	0x08
+#define CH34X_CTRL_TYPE_FRAMING 0x44
+#define CH34X_CTRL_TYPE_PARITY  0x04
+#define CH34X_CTRL_TYPE_OVERRUN 0x02
+
+/*
+ * Input line errors.
+ */
+#define CH34X_LSR_STATE				0x00
+#define CH34X_LSR_OVERRUN			0x02
+#define CH34X_LSR_RERR				0x04
+#define CH34X_LSR_BREAK				
+#define CH34X_LSR_PARITY			0x00
+#define CH34X_LSR_FRAME				0x40
+#define CH34X_LSR_MODEM				0x08
+
+/*
+ * LCR defines.
+ */
+#define CH34X_LCR_REG_CTRL	   0x80
+#define CH34X_LCR_REG_CLK	   0x04
+#define CH34X_LCR_REG_TIMER	   0x08
+
+#define CH34X_LCR_ENABLE_RX    0x80
+#define CH34X_LCR_ENABLE_TX    0x40
+#define CH34X_LCR_PAR_SPACE    0x38
+#define CH34X_LCR_PAR_MARK     0x28
+#define CH34X_LCR_PAR_EVEN     0x18
+#define CH34X_LCR_PAR_ODD      0x08
+#define CH34X_LCR_STOP_BITS_2  0x04
+#define CH34X_LCR_CS8          0x03
+#define CH34X_LCR_CS7          0x02
+#define CH34X_LCR_CS6          0x01
+#define CH34X_LCR_CS5          0x00
+
+#define CH34X_NBREAK_BITS      0x80
+#define CH34X_NBREAK_AUTOBITS  0x10
+
+/*
+ * Internal driver structures.
+ */
+
+/*
+ * The only reason to have several buffers is to accommodate assumptions
+ * in line disciplines. They ask for empty space amount, receive our URB size,
+ * and proceed to issue several 1-character writes, assuming they will fit.
+ * The very first write takes a complete URB. Fortunately, this only happens
+ * when processing onlcr, so we only need 2 buffers. These values must be
+ * powers of 2.
+ */
+#define CH34X_NW  16
+#define CH34X_NR  16
+
+struct ch34x_wb {
+	unsigned char *buf;
+	dma_addr_t dmah;
+	int len;
+	int use;
+	struct urb *urb;
+	struct ch34x *instance;
+};
+
+struct ch34x_rb {
+	int	size;
+	unsigned char *base;
+	dma_addr_t dma;
+	int	index;
+	struct ch34x *instance;
+};
+
+struct usb_ch34x_line_coding {
+	__u32 dwDTERate;
+	__u8 bCharFormat;
+#define USB_CH34X_1_STOP_BITS			0
+#define USB_CH34X_1_5_STOP_BITS			1
+#define USB_CH34X_2_STOP_BITS			2
+
+	__u8 bParityType;
+#define USB_CH34X_NO_PARITY				0
+#define USB_CH34X_ODD_PARITY			1
+#define USB_CH34X_EVEN_PARITY			2
+#define USB_CH34X_MARK_PARITY			3
+#define USB_CH34X_SPACE_PARITY			4
+
+	__u8 bDataBits;
+} __attribute__ ((packed));
+
+typedef enum {
+	CHIP_CH342F = 0x00,
+	CHIP_CH342GJK,
+	CHIP_CH343G,
+	CHIP_CH343G_AUTOBAUD,
+	CHIP_CH343K,
+	CHIP_CH343J,
+	CHIP_CH9102F,
+	CHIP_CH9102X,
+} CHIPTYPE;
+
+struct ch34x {
+	struct usb_device *dev;				/* the corresponding usb device */
+	struct usb_interface *control;			/* control interface */
+	struct usb_interface *data;			/* data interface */
+	struct tty_port port;			 	/* our tty port data */
+	struct urb *ctrlurb;				/* urbs */
+	u8 *ctrl_buffer;				/* buffers of urbs */
+	dma_addr_t ctrl_dma;				/* dma handles of buffers */
+	struct ch34x_wb wb[CH34X_NW];
+	unsigned long read_urbs_free;
+	struct urb *read_urbs[CH34X_NR];
+	struct ch34x_rb read_buffers[CH34X_NR];
+	int rx_buflimit;
+	int rx_endpoint;
+	spinlock_t read_lock;
+	int write_used;					/* number of non-empty write buffers */
+	int transmitting;
+	spinlock_t write_lock;
+	struct mutex mutex;
+	bool disconnected;
+	struct usb_ch34x_line_coding line;		/* bits, stop, parity */
+	struct work_struct work;			/* work queue entry for line discipline waking up */
+	unsigned int ctrlin;				/* input control lines (DCD, DSR, RI, break, overruns) */
+	unsigned int ctrlout;				/* output control lines (DTR, RTS) */
+	struct async_icount iocount;			/* counters for control line changes */
+	struct async_icount oldcount;			/* for comparison of counter */
+	wait_queue_head_t wioctl;			/* for ioctl */
+	unsigned int writesize;				/* max packet size for the output bulk endpoint */
+	unsigned int readsize,ctrlsize;			/* buffer sizes for freeing */
+	unsigned int minor;				/* ch34x minor number */
+	unsigned char clocal;				/* termios CLOCAL */
+	unsigned int susp_count;			/* number of suspended interfaces */
+	unsigned int throttled:1;			/* actually throttled */
+	unsigned int throttle_req:1;			/* throttle requested */
+	u8 bInterval;
+	struct usb_anchor delayed;			/* writes queued for a device about to be woken */
+	unsigned long quirks;
+	u8 iface;
+	CHIPTYPE chiptype;
+	u16 idVendor;
+	u16 idProduct;
+	u8 gpio5dir;
+};
+
+#define CDC_DATA_INTERFACE_TYPE	0x0a
+
+/* constants describing various quirks and errors */
+#define NO_UNION_NORMAL				BIT(0)
+#define SINGLE_RX_URB				BIT(1)
+#define NO_CAP_LINE					BIT(2)
+#define NO_DATA_INTERFACE			BIT(4)
+#define IGNORE_DEVICE				BIT(5)
+#define QUIRK_CONTROL_LINE_STATE	BIT(6)
+#define CLEAR_HALT_CONDITIONS		BIT(7)
+
+

root/package/link4all/ch9344/Makefile

@@ -0,0 +1,45 @@
+#
+# Copyright (c) 2014 The Linux Foundation. All rights reserved.
+#
+
+include $(TOPDIR)/rules.mk
+include $(INCLUDE_DIR)/kernel.mk
+
+PKG_NAME:=usb-serial-ch9344
+PKG_VERSION:=2022-03-01-1026
+PKG_RELEASE:=1
+
+
+PKG_BUILD_DIR:=$(KERNEL_BUILD_DIR)/$(PKG_NAME)
+
+include $(INCLUDE_DIR)/package.mk
+
+define KernelPackage/usb-serial-ch9344
+  SUBMENU:=USB Support
+  DEPENDS:=+kmod-usb-serial
+  TITLE:=Kernel USB driver for ch342/3
+  FILES:= $(PKG_BUILD_DIR)/ch9344.ko
+  AUTOLOAD:=$(call AutoLoad,81,ch9344)
+endef
+
+define KernelPackage/usb-serial-ch9344/Description
+This package contains a USB driver for ch9344
+endef
+
+define Build/Prepare
+	$(CP) src/* $(PKG_BUILD_DIR)
+	$(call Build/Prepare/Default)
+endef
+
+MAKE_OPTS:= \
+	$(KERNEL_MAKE_FLAGS) \
+	M="$(PKG_BUILD_DIR)"
+
+define Build/Compile
+	$(MAKE) -C "$(LINUX_DIR)" \
+		$(MAKE_OPTS) \
+		modules
+endef
+
+$(eval $(call KernelPackage,usb-serial-ch9344))
+

root/package/link4all/ch9344/src/Makefile

@@ -0,0 +1,3 @@
+obj-m += ch9344.o
+
+

root/package/link4all/ch9344/src/ch9344.h

@@ -0,0 +1,199 @@
+#ifndef _CH9344_H
+#define _CH9344_H
+
+/*
+ * Baud rate and default timeout
+ */
+#define DEFAULT_BAUD_RATE 9600
+#define DEFAULT_TIMEOUT   2000
+
+/*
+ * CMSPAR, some architectures can't have space and mark parity.
+ */
+
+#ifndef CMSPAR
+#define CMSPAR			0
+#endif
+
+/*
+ * Major and minor numbers.
+ */
+
+#define CH9344_TTY_MAJOR		168
+#define CH9344_TTY_MINORS		256
+
+
+#define CH9344_CTO_D		0x01
+#define CH9344_CTO_R		0x02
+#define CH9344_CTI_C		0x01
+#define CH9344_CTI_DS		0x02
+#define CH9344_CTI_R		0x04
+#define CH9344_CTI_DC		0x08
+
+#define CH9344_LO			0x10
+#define CH9344_LP			0x20
+#define CH9344_LF			0x40
+#define CH9344_LB			0x80
+
+#define CMD_W_R				0xC0
+#define CMD_W_BR			0x80
+#define CMD_S_T		   		0x20
+
+#define CMD_WB_E			0x90
+#define CMD_RB_E 			0xC0
+
+#define M_NOR   			0x00
+#define M_RS    			0x01
+#define M_IO    			0x02
+#define M_HF 				0x03
+
+#define G_DO 				0x01
+#define G_DI	  			0x00
+
+#define R_MOD 				0x97
+#define R_IO_D  			0x98
+#define R_IO_O  			0x99
+#define R_IO_I   			0x9b
+#define R_TM_O				0x9c
+#define R_INIT				0xa1
+
+#define R_C1 				0x01
+#define R_C2 				0x02
+#define R_C3 				0x03
+#define R_C4 				0x04
+#define R_C5 				0x06
+
+#define R_II_B1 			0x06
+#define R_II_B2 			0x02
+#define R_II_B3				0x00
+
+/*
+ * Internal driver structures.
+ */
+
+#define CH9344_NW  16
+#define CH9344_NR  32
+
+#define NUMSTEP 8
+#define MAXGPIO 12
+#define MAXPORT 8
+
+#define IO_H 1
+#define IO_L 0
+
+struct ch9344_wb {
+	unsigned char *buf;
+	dma_addr_t dmah;
+	int len;
+	int use;
+	struct urb		*urb;
+	struct ch9344		*instance;
+	int portnum;
+};
+
+struct ch9344_rb {
+	int			size;
+	unsigned char		*base;
+	dma_addr_t		dma;
+	int			index;
+	struct ch9344		*instance;
+};
+
+struct usb_ch9344_line_coding {
+	__le32	dwDTERate;
+	__u8	bCharFormat;
+#define SB1			0
+#define SB1_5			1
+#define SB2			2
+
+	__u8	bParityType;
+#define PAN			0
+#define PAO			1
+#define PAE			2
+#define PAM			3
+#define PAS			4
+
+	__u8	bDataBits;
+} __attribute__((packed));
+
+struct ch9344_ttyport {
+	struct tty_port port;
+	int portnum;
+	void *portdata;
+	bool write_empty;
+	struct usb_ch9344_line_coding line;		/* bits, stop, parity */
+	unsigned int ctrlin;				/* input control lines (DCD, DSR, RI, break, overruns) */
+	unsigned int ctrlout;				/* output control lines (DTR, RTS) */
+	struct async_icount iocount;			/* counters for control line changes */
+	struct async_icount oldcount;			/* for comparison of counter */
+	u8 uartmode;					/* uart mode */
+	unsigned char clocal;				/* termios CLOCAL */
+	wait_queue_head_t wioctl;			/* for write */
+	wait_queue_head_t wmodemioctl;			/* for ioctl */
+	bool isopen;
+	struct work_struct work;			/* work queue entry for line discipline waking up */
+};
+
+typedef enum {
+	CHIP_CH9344 = 0,
+	CHIP_CH348 = 1,
+} CHIPTYPE;
+
+struct ch9344 {
+	struct usb_device *dev;				/* the corresponding usb device */
+	struct usb_interface *control;			/* control interface */
+	struct usb_interface *data;			/* data interface */
+	unsigned int num_ports;
+	bool modeline9;
+	struct ch9344_ttyport ttyport[MAXPORT];		/* our tty port data */
+	CHIPTYPE chiptype;
+	int port_offset;
+
+	struct urb *cmdreadurb;				/* urbs */
+	u8 *cmdread_buffer;				/* buffers of urbs */
+	dma_addr_t cmdread_dma;				/* dma handles of buffers */
+
+	struct work_struct tmpwork;			/* work queue entry for line discipline waking up */
+	int opencounts;
+	struct ch9344_wb wb[CH9344_NW];
+	unsigned long read_urbs_free;
+	struct urb *read_urbs[CH9344_NR];
+	struct ch9344_rb read_buffers[CH9344_NR];
+	int rx_buflimit;
+	int rx_endpoint;
+	int tx_endpoint;
+	int cmdtx_endpoint;
+	int cmdrx_endpoint;
+	int ctrl_endpoint;
+
+	spinlock_t read_lock;
+	int write_used;					/* number of non-empty write buffers */
+	int transmitting;
+	spinlock_t write_lock;
+	struct mutex mutex;
+	bool disconnected;
+	u8 gpiodir[MAXGPIO];				/* gpio direction */
+	u8 gpioval[MAXGPIO];				/* gpio output value */
+	u16 gpiovalin;					/* gpio input value */
+	bool gpio_recv;					/* gpio input sync flag */
+	wait_queue_head_t wgpioioctl;			/* for gpio input ioctl */
+	struct mutex gpiomutex;
+	unsigned int writesize;				/* max packet size for the output bulk endpoint */
+	unsigned int readsize, cmdsize;			/* buffer sizes for freeing */
+	unsigned int ctrlsize;
+	unsigned int minor;				/* ch9344 minor number */
+	unsigned int susp_count;			/* number of suspended interfaces */
+	u8 bInterval;
+	struct usb_anchor delayed;			/* writes queued for a device about to be woken */
+	unsigned long quirks;
+};
+
+
+/* constants describing various quirks and errors */
+#define SINGLE_RX_URB			BIT(1)
+#define NO_DATA_INTERFACE		BIT(4)
+#define IGNORE_DEVICE			BIT(5)
+#define QUIRK_CONTROL_LINE_STATE	BIT(6)
+#define CLEAR_HALT_CONDITIONS		BIT(7)
+
+#endif

root/package/link4all/gobinet/Makefile

@@ -0,0 +1,54 @@
+#
+# Copyright (c) 2014 The Linux Foundation. All rights reserved.
+#
+
+include $(TOPDIR)/rules.mk
+include $(INCLUDE_DIR)/kernel.mk
+
+PKG_NAME:=GobiNet
+PKG_VERSION:=2011-07-29-1026
+PKG_RELEASE:=1
+
+
+PKG_BUILD_DIR:=$(KERNEL_BUILD_DIR)/$(PKG_NAME)
+
+include $(INCLUDE_DIR)/package.mk
+
+define KernelPackage/usb-gobi-net
+  CATEGORY:=LINK4ALL
+  DEPENDS:=+kmod-usb-net
+  TITLE:=Kernel USB driver for GobiNet
+  FILES:= $(PKG_BUILD_DIR)/GobiNet.ko
+  AUTOLOAD:=$(call AutoLoad,81,GobiNet)
+endef
+
+define KernelPackage/GobiNet/Description
+This package contains a USB driver for GobiNet3000
+endef
+
+define Build/Prepare
+	$(CP) src/* $(PKG_BUILD_DIR)
+	$(call Build/Prepare/Default)
+endef
+
+# define Build/Compile
+# 	$(MAKE) -C "$(LINUX_DIR)" \
+# 		CROSS_COMPILE="$(TARGET_CROSS)" \
+# 		ARCH="$(LINUX_KARCH)" \
+# 		SUBDIRS="$(PKG_BUILD_DIR)" \
+# 		EXTRA_CFLAGS="$(EXTRA_CFLAGS)" \
+# 		modules
+# endef
+
+MAKE_OPTS:= \
+	$(KERNEL_MAKE_FLAGS) \
+	M="$(PKG_BUILD_DIR)"
+
+define Build/Compile
+	$(MAKE) -C "$(LINUX_DIR)" \
+		$(MAKE_OPTS) \
+		modules
+endef
+
+$(eval $(call KernelPackage,usb-gobi-net))
+

root/package/link4all/gobinet/patches/001-atomic_read.patch

@@ -0,0 +1,14 @@
+Index: src/QMIDevice.c
+===================================================================
+--- src.orig/QMIDevice.c
++++ src/QMIDevice.c
+@@ -3391,7 +3391,8 @@ void DeregisterQMIDevice( sGobiUSBNet *
+    // but exists to prevent an infinate loop just in case.
+    for (tries = 0; tries < 30 * 100; tries++)
+    {
+-      int ref = atomic_read( &pDev->mQMIDev.mCdev.kobj.kref.refcount );
++      // int ref = atomic_read( &pDev->mQMIDev.mCdev.kobj.kref.refcount );
++      int ref = refcount_read( &pDev->mQMIDev.mCdev.kobj.kref.refcount );
+       if (ref > 1)
+       {
+          DBG( "cdev in use by %d tasks\n", ref - 1 ); 

root/package/link4all/gobinet/src.ec25/Makefile

@@ -0,0 +1,30 @@
+obj-m := GobiNet.o
+GobiNet-objs := GobiUSBNet.o QMIDevice.o QMI.o
+
+PWD := $(shell pwd)
+OUTPUTDIR=/lib/modules/`uname -r`/kernel/drivers/net/usb/
+
+ifeq ($(ARCH),)
+ARCH := $(shell uname -m)
+endif
+ifeq ($(CROSS_COMPILE),)
+CROSS_COMPILE :=
+endif
+ifeq ($(KDIR),)
+KDIR := /lib/modules/$(shell uname -r)/build
+endif
+
+default:
+	ln -sf makefile Makefile
+	$(MAKE) ARCH=${ARCH} CROSS_COMPILE=${CROSS_COMPILE} -C $(KDIR) M=$(PWD) modules
+
+install: default
+	mkdir -p $(OUTPUTDIR)
+	cp -f GobiNet.ko $(OUTPUTDIR)
+	depmod
+	modprobe -r GobiNet
+	modprobe GobiNet
+
+clean:
+	rm -rf Makefile
+	rm -rf *.o *~ core .depend .*.cmd *.ko *.mod.c .tmp_versions Module.* modules.order

root/package/link4all/gobinet/src.ec25/QMI.h

@@ -0,0 +1,328 @@
+/*===========================================================================
+FILE:
+   QMI.h
+
+DESCRIPTION:
+   Qualcomm QMI driver header
+   
+FUNCTIONS:
+   Generic QMUX functions
+      ParseQMUX
+      FillQMUX
+   
+   Generic QMI functions
+      GetTLV
+      ValidQMIMessage
+      GetQMIMessageID
+
+   Get sizes of buffers needed by QMI requests
+      QMUXHeaderSize
+      QMICTLGetClientIDReqSize
+      QMICTLReleaseClientIDReqSize
+      QMICTLReadyReqSize
+      QMIWDSSetEventReportReqSize
+      QMIWDSGetPKGSRVCStatusReqSize
+      QMIDMSGetMEIDReqSize
+      QMICTLSyncReqSize
+
+   Fill Buffers with QMI requests
+      QMICTLGetClientIDReq
+      QMICTLReleaseClientIDReq
+      QMICTLReadyReq
+      QMIWDSSetEventReportReq
+      QMIWDSGetPKGSRVCStatusReq
+      QMIDMSGetMEIDReq
+      QMICTLSetDataFormatReq
+      QMICTLSyncReq
+      
+   Parse data from QMI responses
+      QMICTLGetClientIDResp
+      QMICTLReleaseClientIDResp
+      QMIWDSEventResp
+      QMIDMSGetMEIDResp
+
+Copyright (c) 2011, Code Aurora Forum. All rights reserved.
+
+Redistribution and use in source and binary forms, with or without
+modification, are permitted provided that the following conditions are met:
+    * Redistributions of source code must retain the above copyright
+      notice, this list of conditions and the following disclaimer.
+    * Redistributions in binary form must reproduce the above copyright
+      notice, this list of conditions and the following disclaimer in the
+      documentation and/or other materials provided with the distribution.
+    * Neither the name of Code Aurora Forum nor
+      the names of its contributors may be used to endorse or promote
+      products derived from this software without specific prior written
+      permission.
+
+
+THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
+ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
+LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
+CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
+SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
+INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
+CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
+ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
+POSSIBILITY OF SUCH DAMAGE.
+===========================================================================*/
+
+#pragma once
+
+/*=========================================================================*/
+// Definitions
+/*=========================================================================*/
+
+extern int debug;
+// DBG macro
+#define DBG( format, arg... ) do { \
+   if (debug == 1)\
+   { \
+      printk( KERN_INFO "GobiNet::%s " format, __FUNCTION__, ## arg ); \
+   } }while(0)
+
+#if 0
+#define VDBG( format, arg... ) do { \
+   if (debug == 1)\
+   { \
+      printk( KERN_INFO "GobiNet::%s " format, __FUNCTION__, ## arg ); \
+   } } while(0)
+#else
+#define VDBG( format, arg... ) do { } while(0)
+#endif
+
+#define INFO( format, arg... ) do { \
+      printk( KERN_INFO "GobiNet::%s " format, __FUNCTION__, ## arg ); \
+   }while(0)
+
+// QMI Service Types
+#define QMICTL 0
+#define QMIWDS 1
+#define QMIDMS 2
+#define QMINAS 3
+#define QMIUIM 11
+#define QMIWDA 0x1A
+
+#define u8        unsigned char
+#define u16       unsigned short
+#define u32       unsigned int
+#define u64       unsigned long long
+
+#define bool      u8
+#define true      1
+#define false     0
+
+#define ENOMEM    12
+#define EFAULT    14
+#define EINVAL    22
+#ifndef ENOMSG
+#define ENOMSG    42
+#endif
+#define ENODATA   61
+
+#define TLV_TYPE_LINK_PROTO 0x10
+
+/*=========================================================================*/
+// Struct sQMUX
+//
+//    Structure that defines a QMUX header
+/*=========================================================================*/
+typedef struct sQMUX
+{
+   /* T\F, always 1 */
+   u8         mTF;
+
+   /* Size of message */
+   u16        mLength;
+
+   /* Control flag */
+   u8         mCtrlFlag;
+   
+   /* Service Type */
+   u8         mQMIService;
+   
+   /* Client ID */
+   u8         mQMIClientID;
+
+}__attribute__((__packed__)) sQMUX;
+
+/*=========================================================================*/
+// Generic QMUX functions
+/*=========================================================================*/
+
+// Remove QMUX headers from a buffer
+int ParseQMUX(
+   u16 *    pClientID,
+   void *   pBuffer,
+   u16      buffSize );
+
+// Fill buffer with QMUX headers
+int FillQMUX(
+   u16      clientID,
+   void *   pBuffer,
+   u16      buffSize );
+
+/*=========================================================================*/
+// Generic QMI functions
+/*=========================================================================*/
+
+// Get data buffer of a specified TLV from a QMI message
+int GetTLV(
+   void *   pQMIMessage,
+   u16      messageLen,
+   u8       type,
+   void *   pOutDataBuf,
+   u16      bufferLen );
+
+// Check mandatory TLV in a QMI message
+int ValidQMIMessage(
+   void *   pQMIMessage,
+   u16      messageLen );
+
+// Get the message ID of a QMI message
+int GetQMIMessageID(
+   void *   pQMIMessage,
+   u16      messageLen );
+
+/*=========================================================================*/
+// Get sizes of buffers needed by QMI requests
+/*=========================================================================*/
+
+// Get size of buffer needed for QMUX
+u16 QMUXHeaderSize( void );
+
+// Get size of buffer needed for QMUX + QMICTLGetClientIDReq
+u16 QMICTLGetClientIDReqSize( void );
+
+// Get size of buffer needed for QMUX + QMICTLReleaseClientIDReq
+u16 QMICTLReleaseClientIDReqSize( void );
+
+// Get size of buffer needed for QMUX + QMICTLReadyReq
+u16 QMICTLReadyReqSize( void );
+
+// Get size of buffer needed for QMUX + QMIWDSSetEventReportReq
+u16 QMIWDSSetEventReportReqSize( void );
+
+// Get size of buffer needed for QMUX + QMIWDSGetPKGSRVCStatusReq
+u16 QMIWDSGetPKGSRVCStatusReqSize( void );
+
+u16 QMIWDSSetQMUXBindMuxDataPortSize( void );
+
+// Get size of buffer needed for QMUX + QMIDMSGetMEIDReq
+u16 QMIDMSGetMEIDReqSize( void );
+
+// Get size of buffer needed for QMUX + QMIWDASetDataFormatReq
+u16 QMIWDASetDataFormatReqSize( void );
+
+// Get size of buffer needed for QMUX + QMICTLSyncReq
+u16 QMICTLSyncReqSize( void );
+
+/*=========================================================================*/
+// Fill Buffers with QMI requests
+/*=========================================================================*/
+
+// Fill buffer with QMI CTL Get Client ID Request
+int QMICTLGetClientIDReq(
+   void *   pBuffer,
+   u16      buffSize,
+   u8       transactionID,
+   u8       serviceType );
+
+// Fill buffer with QMI CTL Release Client ID Request
+int QMICTLReleaseClientIDReq(
+   void *   pBuffer,
+   u16      buffSize,
+   u8       transactionID,
+   u16      clientID );
+
+// Fill buffer with QMI CTL Get Version Info Request
+int QMICTLReadyReq(
+   void *   pBuffer,
+   u16      buffSize,
+   u8       transactionID );
+
+// Fill buffer with QMI WDS Set Event Report Request
+int QMIWDSSetEventReportReq(
+   void *   pBuffer,
+   u16      buffSize,
+   u16      transactionID );
+
+// Fill buffer with QMI WDS Get PKG SRVC Status Request
+int QMIWDSGetPKGSRVCStatusReq(
+   void *   pBuffer,
+   u16      buffSize,
+   u16      transactionID );
+
+u16 QMIWDSSetQMUXBindMuxDataPortReq(
+   void *   pBuffer,
+   u16      buffSize,
+   u16      transactionID );
+
+// Fill buffer with QMI DMS Get Serial Numbers Request
+int QMIDMSGetMEIDReq(
+   void *   pBuffer,
+   u16      buffSize,
+   u16      transactionID );
+
+// Fill buffer with QMI WDA Set Data Format Request
+int QMIWDASetDataFormatReq(
+   void *   pBuffer,
+   u16      buffSize,
+   bool     bRawIPMode,
+   u16      transactionID );
+
+int QMICTLSyncReq(
+   void *   pBuffer,
+   u16      buffSize,
+   u16      transactionID );
+
+/*=========================================================================*/
+// Parse data from QMI responses
+/*=========================================================================*/
+
+// Parse the QMI CTL Get Client ID Resp
+int QMICTLGetClientIDResp(
+   void * pBuffer,
+   u16    buffSize,
+   u16 *  pClientID );
+
+// Verify the QMI CTL Release Client ID Resp is valid
+int QMICTLReleaseClientIDResp(
+   void *   pBuffer,
+   u16      buffSize );
+
+// Parse the QMI WDS Set Event Report Resp/Indication or
+//    QMI WDS Get PKG SRVC Status Resp/Indication
+int QMIWDSEventResp(
+   void *   pBuffer,
+   u16      buffSize,
+   u32 *    pTXOk,
+   u32 *    pRXOk,
+   u32 *    pTXErr,
+   u32 *    pRXErr,
+   u32 *    pTXOfl,
+   u32 *    pRXOfl,
+   u64 *    pTXBytesOk,
+   u64 *    pRXBytesOk,
+   bool *   pbLinkState,
+   bool *   pbReconfigure );
+
+// Parse the QMI DMS Get Serial Numbers Resp
+int QMIDMSGetMEIDResp(
+   void *   pBuffer,
+   u16      buffSize,
+   char *   pMEID,
+   int      meidSize );
+
+// Parse the QMI DMS Get Serial Numbers Resp
+int QMIWDASetDataFormatResp(
+   void *   pBuffer,
+   u16      buffSize, bool bRawIPMode );
+
+// Pasre the QMI CTL Sync Response
+int QMICTLSyncResp(
+   void *pBuffer,
+   u16  buffSize );
+

root/package/link4all/gobinet/src.ec25/QMIDevice.h

@@ -0,0 +1,345 @@
+/*===========================================================================
+FILE:
+   QMIDevice.h
+
+DESCRIPTION:
+   Functions related to the QMI interface device
+   
+FUNCTIONS:
+   Generic functions
+      IsDeviceValid
+      PrintHex
+      GobiSetDownReason
+      GobiClearDownReason
+      GobiTestDownReason
+
+   Driver level asynchronous read functions
+      ResubmitIntURB
+      ReadCallback
+      IntCallback
+      StartRead
+      KillRead
+
+   Internal read/write functions
+      ReadAsync
+      UpSem
+      ReadSync
+      WriteSyncCallback
+      WriteSync
+
+   Internal memory management functions
+      GetClientID
+      ReleaseClientID
+      FindClientMem
+      AddToReadMemList
+      PopFromReadMemList
+      AddToNotifyList
+      NotifyAndPopNotifyList
+      AddToURBList
+      PopFromURBList
+
+   Internal userspace wrapper functions
+      UserspaceunlockedIOCTL
+
+   Userspace wrappers
+      UserspaceOpen
+      UserspaceIOCTL
+      UserspaceClose
+      UserspaceRead
+      UserspaceWrite
+      UserspacePoll
+
+   Initializer and destructor
+      RegisterQMIDevice
+      DeregisterQMIDevice
+
+   Driver level client management
+      QMIReady
+      QMIWDSCallback
+      SetupQMIWDSCallback
+      QMIDMSGetMEID
+
+Copyright (c) 2011, Code Aurora Forum. All rights reserved.
+
+Redistribution and use in source and binary forms, with or without
+modification, are permitted provided that the following conditions are met:
+    * Redistributions of source code must retain the above copyright
+      notice, this list of conditions and the following disclaimer.
+    * Redistributions in binary form must reproduce the above copyright
+      notice, this list of conditions and the following disclaimer in the
+      documentation and/or other materials provided with the distribution.
+    * Neither the name of Code Aurora Forum nor
+      the names of its contributors may be used to endorse or promote
+      products derived from this software without specific prior written
+      permission.
+
+
+THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
+ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
+LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
+CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
+SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
+INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
+CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
+ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
+POSSIBILITY OF SUCH DAMAGE.
+===========================================================================*/
+
+//---------------------------------------------------------------------------
+// Pragmas
+//---------------------------------------------------------------------------
+#pragma once
+
+//---------------------------------------------------------------------------
+// Include Files
+//---------------------------------------------------------------------------
+#include "Structs.h"
+#include "QMI.h"
+
+/*=========================================================================*/
+// Generic functions
+/*=========================================================================*/
+
+// Basic test to see if device memory is valid
+bool IsDeviceValid( sGobiUSBNet * pDev );
+
+// Print Hex data, for debug purposes
+void PrintHex(
+   void *         pBuffer,
+   u16            bufSize );
+
+// Sets mDownReason and turns carrier off
+void GobiSetDownReason(
+   sGobiUSBNet *    pDev,
+   u8                 reason );
+
+// Clear mDownReason and may turn carrier on
+void GobiClearDownReason(
+   sGobiUSBNet *    pDev,
+   u8                 reason );
+
+// Tests mDownReason and returns whether reason is set
+bool GobiTestDownReason(
+   sGobiUSBNet *    pDev,
+   u8                 reason );
+
+/*=========================================================================*/
+// Driver level asynchronous read functions
+/*=========================================================================*/
+
+// Resubmit interrupt URB, re-using same values
+int ResubmitIntURB( struct urb * pIntURB );
+
+// Read callback
+//    Put the data in storage and notify anyone waiting for data
+#if (LINUX_VERSION_CODE > KERNEL_VERSION( 2,6,18 ))
+void ReadCallback( struct urb * pReadURB );
+#else
+void ReadCallback(struct urb *pReadURB, struct pt_regs *regs);
+#endif
+
+// Inturrupt callback
+//    Data is available, start a read URB
+#if (LINUX_VERSION_CODE > KERNEL_VERSION( 2,6,18 ))
+void IntCallback( struct urb * pIntURB );
+#else
+void IntCallback(struct urb *pIntURB, struct pt_regs *regs);
+#endif
+
+// Start continuous read "thread"
+int StartRead( sGobiUSBNet * pDev );
+
+// Kill continuous read "thread"
+void KillRead( sGobiUSBNet * pDev );
+
+/*=========================================================================*/
+// Internal read/write functions
+/*=========================================================================*/
+
+// Start asynchronous read
+//     Reading client's data store, not device
+int ReadAsync(
+   sGobiUSBNet *    pDev,
+   u16                clientID,
+   u16                transactionID,
+   void               (*pCallback)(sGobiUSBNet *, u16, void *),
+   void *             pData );
+
+// Notification function for synchronous read
+void UpSem( 
+   sGobiUSBNet *    pDev,
+   u16                clientID,
+   void *             pData );
+
+// Start synchronous read
+//     Reading client's data store, not device
+int ReadSync(
+   sGobiUSBNet *    pDev,
+   void **            ppOutBuffer,
+   u16                clientID,
+   u16                transactionID );
+
+// Write callback
+#if (LINUX_VERSION_CODE > KERNEL_VERSION( 2,6,18 ))
+void WriteSyncCallback( struct urb * pWriteURB );
+#else
+void WriteSyncCallback(struct urb *pWriteURB, struct pt_regs *regs);
+#endif
+
+// Start synchronous write
+int WriteSync(
+   sGobiUSBNet *    pDev,
+   char *             pInWriteBuffer,
+   int                size,
+   u16                clientID );
+
+/*=========================================================================*/
+// Internal memory management functions
+/*=========================================================================*/
+
+// Create client and allocate memory
+int GetClientID( 
+   sGobiUSBNet *      pDev,
+   u8                   serviceType );
+
+// Release client and free memory
+void ReleaseClientID(
+   sGobiUSBNet *      pDev,
+   u16                  clientID );
+
+// Find this client's memory
+sClientMemList * FindClientMem(
+   sGobiUSBNet *      pDev,
+   u16                  clientID );
+
+// Add Data to this client's ReadMem list
+bool AddToReadMemList( 
+   sGobiUSBNet *      pDev,
+   u16                  clientID,
+   u16                  transactionID,
+   void *               pData,
+   u16                  dataSize );
+
+// Remove data from this client's ReadMem list if it matches 
+// the specified transaction ID.
+bool PopFromReadMemList( 
+   sGobiUSBNet *      pDev,
+   u16                  clientID,
+   u16                  transactionID,
+   void **              ppData,
+   u16 *                pDataSize );
+
+// Add Notify entry to this client's notify List
+bool AddToNotifyList( 
+   sGobiUSBNet *      pDev,
+   u16                  clientID,
+   u16                  transactionID,
+   void                 (* pNotifyFunct)(sGobiUSBNet *, u16, void *),
+   void *               pData );
+
+// Remove first Notify entry from this client's notify list 
+//    and Run function
+bool NotifyAndPopNotifyList( 
+   sGobiUSBNet *      pDev,
+   u16                  clientID,
+   u16                  transactionID );
+
+// Add URB to this client's URB list
+bool AddToURBList( 
+   sGobiUSBNet *      pDev,
+   u16                  clientID,
+   struct urb *         pURB );
+
+// Remove URB from this client's URB list
+struct urb * PopFromURBList( 
+   sGobiUSBNet *      pDev,
+   u16                  clientID );
+
+/*=========================================================================*/
+// Internal userspace wrappers
+/*=========================================================================*/
+
+// Userspace unlocked ioctl
+long UserspaceunlockedIOCTL(
+   struct file *     pFilp,
+   unsigned int      cmd,
+   unsigned long     arg );
+
+/*=========================================================================*/
+// Userspace wrappers
+/*=========================================================================*/
+
+// Userspace open
+int UserspaceOpen( 
+   struct inode *   pInode, 
+   struct file *    pFilp );
+
+// Userspace ioctl
+int UserspaceIOCTL( 
+   struct inode *    pUnusedInode, 
+   struct file *     pFilp,
+   unsigned int      cmd, 
+   unsigned long     arg );
+
+// Userspace close
+#if (LINUX_VERSION_CODE > KERNEL_VERSION( 2,6,14 ))
+int UserspaceClose( 
+   struct file *       pFilp,
+   fl_owner_t          unusedFileTable );
+#else
+int UserspaceClose( struct file *       pFilp );
+#endif
+
+// Userspace read (synchronous)
+ssize_t UserspaceRead( 
+   struct file *        pFilp,
+   char __user *        pBuf, 
+   size_t               size,
+   loff_t *             pUnusedFpos );
+
+// Userspace write (synchronous)
+ssize_t UserspaceWrite(
+   struct file *        pFilp, 
+   const char __user *  pBuf, 
+   size_t               size,
+   loff_t *             pUnusedFpos );
+
+unsigned int UserspacePoll(
+   struct file *                  pFilp,
+   struct poll_table_struct *     pPollTable );
+
+/*=========================================================================*/
+// Initializer and destructor
+/*=========================================================================*/
+
+// QMI Device initialization function
+int RegisterQMIDevice( sGobiUSBNet * pDev );
+
+// QMI Device cleanup function
+void DeregisterQMIDevice( sGobiUSBNet * pDev );
+
+/*=========================================================================*/
+// Driver level client management
+/*=========================================================================*/
+
+// Check if QMI is ready for use
+bool QMIReady(
+   sGobiUSBNet *    pDev,
+   u16                timeout );
+
+// QMI WDS callback function
+void QMIWDSCallback(
+   sGobiUSBNet *    pDev,
+   u16                clientID,
+   void *             pData );
+
+// Fire off reqests and start async read for QMI WDS callback
+int SetupQMIWDSCallback( sGobiUSBNet * pDev );
+
+// Register client, send req and parse MEID response, release client
+int QMIDMSGetMEID( sGobiUSBNet * pDev );
+
+// Register client, send req and parse Data format response, release client
+int QMIWDASetDataFormat( sGobiUSBNet * pDev );

root/package/link4all/gobinet/src.ec25/Readme.txt

@@ -0,0 +1,78 @@
+Gobi3000 network driver 2011-07-29-1026
+
+This readme covers important information concerning 
+the Gobi Net driver.
+
+Table of Contents
+
+1. What's new in this release
+2. Known issues
+3. Known platform issues
+
+
+-------------------------------------------------------------------------------
+
+1. WHAT'S NEW
+
+This Release (Gobi3000 network driver 2011-07-29-1026)
+a. Signal the device to leave low power mode on enumeration
+b. Add "txQueueLength" parameter, which will set the Tx Queue Length
+c. Send SetControlLineState message during driver/device removal
+d. Change to new date-based versioning scheme
+
+Prior Release (Gobi3000 network driver 1.0.60) 06/29/2011
+a. Add UserspacePoll() function, to support select()
+b. Fix possible deadlock on GobiUSBNetTXTimeout()
+c. Fix memory leak on data transmission
+
+Prior Release (Gobi3000 network driver 1.0.50) 05/18/2011
+a. Add support for kernels up to 2.6.38
+b. Add support for dynamic interface binding
+
+Prior Release (Gobi3000 network driver 1.0.40) 02/28/2011
+a. In cases of QMI read errors, discard the error and continue reading.
+b. Add "interruptible" parameter, which may be disabled for debugging purposes.
+
+Prior Release (Gobi3000 network driver 1.0.30) 01/05/2011
+a. Fix rare kernel PANIC if a process terminates while file handle close 
+   or device removal is in progress.
+
+Prior Release (Gobi3000 network driver 1.0.20) 11/01/2010
+a. Fix possible kernel WARNING if device removed before QCWWANDisconnect().
+b. Fix multiple memory leaks in error cases.
+
+Prior Release (Gobi3000 network driver 1.0.10) 09/17/2010
+a. Initial release
+
+-------------------------------------------------------------------------------
+
+2. KNOWN ISSUES
+
+No known issues.
+         
+-------------------------------------------------------------------------------
+
+3. KNOWN PLATFORM ISSUES
+
+a. Enabling autosuspend:
+   Autosuspend is supported by the Gobi3000 module and its drivers, 
+   but by default it is not enabled by the open source kernel. As such,
+   the Gobi3000 module will not enter autosuspend unless the
+   user specifically turns on autosuspend with the command:
+      echo auto > /sys/bus/usb/devices/.../power/level
+b. Ksoftirq using 100% CPU:
+   There is a known issue with the open source usbnet driver that can 
+   result in infinite software interrupts. The fix for this is to test 
+   (in the usbnet_bh() function) if the usb_device can submit URBs before 
+   attempting to submit the response URB buffers.
+c. NetworkManager does not recognize connection after resume:
+   After resuming from sleep/hibernate, NetworkManager may not recognize new
+   network connections by the Gobi device. This is a system issue not specific
+   to the Gobi device, which may result in dhcp not being run and the default
+   route not being updated.  One way to fix this is to simply restart the 
+   NetworkManager service.
+
+-------------------------------------------------------------------------------
+
+
+

root/package/link4all/gobinet/src.ec25/Structs.h

@@ -0,0 +1,439 @@
+/*===========================================================================
+FILE:
+   Structs.h
+
+DESCRIPTION:
+   Declaration of structures used by the Qualcomm Linux USB Network driver
+   
+FUNCTIONS:
+   none
+
+Copyright (c) 2011, Code Aurora Forum. All rights reserved.
+
+Redistribution and use in source and binary forms, with or without
+modification, are permitted provided that the following conditions are met:
+    * Redistributions of source code must retain the above copyright
+      notice, this list of conditions and the following disclaimer.
+    * Redistributions in binary form must reproduce the above copyright
+      notice, this list of conditions and the following disclaimer in the
+      documentation and/or other materials provided with the distribution.
+    * Neither the name of Code Aurora Forum nor
+      the names of its contributors may be used to endorse or promote
+      products derived from this software without specific prior written
+      permission.
+
+
+THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
+ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
+LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
+CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
+SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
+INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
+CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
+ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
+POSSIBILITY OF SUCH DAMAGE.
+===========================================================================*/
+
+//---------------------------------------------------------------------------
+// Pragmas
+//---------------------------------------------------------------------------
+#pragma once
+
+//---------------------------------------------------------------------------
+// Include Files
+//---------------------------------------------------------------------------
+#include <linux/etherdevice.h>
+#include <linux/ethtool.h>
+#include <linux/mii.h>
+#include <linux/usb.h>
+#include <linux/version.h>
+#include <linux/cdev.h>
+#include <linux/kthread.h>
+#include <linux/poll.h>
+#include <linux/completion.h>
+
+#if (LINUX_VERSION_CODE <= KERNEL_VERSION( 2,6,21 ))
+static inline void skb_reset_mac_header(struct sk_buff *skb)
+{
+    skb->mac.raw = skb->data;
+}
+#endif
+
+#if (LINUX_VERSION_CODE <= KERNEL_VERSION( 2,6,22 ))
+#define bool      u8
+#ifndef URB_FREE_BUFFER
+#define URB_FREE_BUFFER_BY_SELF //usb_free_urb will not free, should free by self
+#define URB_FREE_BUFFER		0x0100	/* Free transfer buffer with the URB */
+#endif
+
+/**
+ * usb_endpoint_type - get the endpoint's transfer type
+ * @epd: endpoint to be checked
+ *
+ * Returns one of USB_ENDPOINT_XFER_{CONTROL, ISOC, BULK, INT} according
+ * to @epd's transfer type.
+ */
+static inline int usb_endpoint_type(const struct usb_endpoint_descriptor *epd)
+{
+	return epd->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK;
+}
+#endif
+
+#if (LINUX_VERSION_CODE <= KERNEL_VERSION( 2,6,18 ))
+/**
+ * usb_endpoint_dir_in - check if the endpoint has IN direction
+ * @epd: endpoint to be checked
+ *
+ * Returns true if the endpoint is of type IN, otherwise it returns false.
+ */
+static inline int usb_endpoint_dir_in(const struct usb_endpoint_descriptor *epd)
+{
+	return ((epd->bEndpointAddress & USB_ENDPOINT_DIR_MASK) == USB_DIR_IN);
+}
+
+/**
+ * usb_endpoint_dir_out - check if the endpoint has OUT direction
+ * @epd: endpoint to be checked
+ *
+ * Returns true if the endpoint is of type OUT, otherwise it returns false.
+ */
+static inline int usb_endpoint_dir_out(
+				const struct usb_endpoint_descriptor *epd)
+{
+	return ((epd->bEndpointAddress & USB_ENDPOINT_DIR_MASK) == USB_DIR_OUT);
+}
+
+/**
+ * usb_endpoint_xfer_int - check if the endpoint has interrupt transfer type
+ * @epd: endpoint to be checked
+ *
+ * Returns true if the endpoint is of type interrupt, otherwise it returns
+ * false.
+ */
+static inline int usb_endpoint_xfer_int(
+				const struct usb_endpoint_descriptor *epd)
+{
+	return ((epd->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK) ==
+		USB_ENDPOINT_XFER_INT);
+}
+
+static inline int usb_autopm_set_interface(struct usb_interface *intf)
+{ return 0; }
+
+static inline int usb_autopm_get_interface(struct usb_interface *intf)
+{ return 0; }
+
+static inline int usb_autopm_get_interface_async(struct usb_interface *intf)
+{ return 0; }
+
+static inline void usb_autopm_put_interface(struct usb_interface *intf)
+{ }
+static inline void usb_autopm_put_interface_async(struct usb_interface *intf)
+{ }
+static inline void usb_autopm_enable(struct usb_interface *intf)
+{ }
+static inline void usb_autopm_disable(struct usb_interface *intf)
+{ }
+static inline void usb_mark_last_busy(struct usb_device *udev)
+{ }
+#endif
+
+#if (LINUX_VERSION_CODE <= KERNEL_VERSION( 2,6,24 ))
+   #include "usbnet.h"
+#else
+   #include <linux/usb/usbnet.h>
+#endif
+
+#if (LINUX_VERSION_CODE > KERNEL_VERSION( 2,6,25 ))
+   #include <linux/fdtable.h>
+#else
+   #include <linux/file.h>
+#endif
+
+// Used in recursion, defined later below
+struct sGobiUSBNet;
+
+/*=========================================================================*/
+// Struct sReadMemList
+//
+//    Structure that defines an entry in a Read Memory linked list
+/*=========================================================================*/
+typedef struct sReadMemList
+{
+   /* Data buffer */
+   void *                     mpData;
+   
+   /* Transaction ID */
+   u16                        mTransactionID;
+
+   /* Size of data buffer */
+   u16                        mDataSize;
+
+   /* Next entry in linked list */
+   struct sReadMemList *      mpNext;
+
+} sReadMemList;
+
+/*=========================================================================*/
+// Struct sNotifyList
+//
+//    Structure that defines an entry in a Notification linked list
+/*=========================================================================*/
+typedef struct sNotifyList
+{
+   /* Function to be run when data becomes available */
+   void                  (* mpNotifyFunct)(struct sGobiUSBNet *, u16, void *);
+   
+   /* Transaction ID */
+   u16                   mTransactionID;
+
+   /* Data to provide as parameter to mpNotifyFunct */
+   void *                mpData;
+   
+   /* Next entry in linked list */
+   struct sNotifyList *  mpNext;
+
+} sNotifyList;
+
+/*=========================================================================*/
+// Struct sURBList
+//
+//    Structure that defines an entry in a URB linked list
+/*=========================================================================*/
+typedef struct sURBList
+{
+   /* The current URB */
+   struct urb *       mpURB;
+
+   /* Next entry in linked list */
+   struct sURBList *  mpNext;
+
+} sURBList;
+
+/*=========================================================================*/
+// Struct sClientMemList
+//
+//    Structure that defines an entry in a Client Memory linked list
+//      Stores data specific to a Service Type and Client ID
+/*=========================================================================*/
+typedef struct sClientMemList
+{
+   /* Client ID for this Client */
+   u16                          mClientID;
+
+   /* Linked list of Read entries */
+   /*    Stores data read from device before sending to client */
+   sReadMemList *               mpList;
+   
+   /* Linked list of Notification entries */
+   /*    Stores notification functions to be run as data becomes 
+         available or the device is removed */
+   sNotifyList *                mpReadNotifyList;
+
+   /* Linked list of URB entries */
+   /*    Stores pointers to outstanding URBs which need canceled 
+         when the client is deregistered or the device is removed */
+   sURBList *                   mpURBList;
+   
+   /* Next entry in linked list */
+   struct sClientMemList *      mpNext;
+
+   /* Wait queue object for poll() */
+   wait_queue_head_t    mWaitQueue;
+
+} sClientMemList;
+
+/*=========================================================================*/
+// Struct sURBSetupPacket
+//
+//    Structure that defines a USB Setup packet for Control URBs
+//    Taken from USB CDC specifications
+/*=========================================================================*/
+typedef struct sURBSetupPacket
+{
+   /* Request type */
+   u8    mRequestType;
+
+   /* Request code */
+   u8    mRequestCode;
+
+   /* Value */
+   u16   mValue;
+
+   /* Index */
+   u16   mIndex;
+
+   /* Length of Control URB */
+   u16   mLength;
+
+} sURBSetupPacket;
+
+// Common value for sURBSetupPacket.mLength
+#define DEFAULT_READ_URB_LENGTH 0x1000
+
+#ifdef CONFIG_PM
+#if (LINUX_VERSION_CODE < KERNEL_VERSION( 2,6,29 ))
+/*=========================================================================*/
+// Struct sAutoPM
+//
+//    Structure used to manage AutoPM thread which determines whether the
+//    device is in use or may enter autosuspend.  Also submits net 
+//    transmissions asynchronously.
+/*=========================================================================*/
+typedef struct sAutoPM
+{
+   /* Thread for atomic autopm function */
+   struct task_struct *       mpThread;
+
+   /* Signal for completion when it's time for the thread to work */
+   struct completion          mThreadDoWork;
+
+   /* Time to exit? */
+   bool                       mbExit;
+
+   /* List of URB's queued to be sent to the device */
+   sURBList *                 mpURBList;
+
+   /* URB list lock (for adding and removing elements) */
+   spinlock_t                 mURBListLock;
+
+   /* Length of the URB list */
+   atomic_t                   mURBListLen;
+   
+   /* Active URB */
+   struct urb *               mpActiveURB;
+
+   /* Active URB lock (for adding and removing elements) */
+   spinlock_t                 mActiveURBLock;
+   
+   /* Duplicate pointer to USB device interface */
+   struct usb_interface *     mpIntf;
+
+} sAutoPM;
+#endif
+#endif /* CONFIG_PM */
+
+/*=========================================================================*/
+// Struct sQMIDev
+//
+//    Structure that defines the data for the QMI device
+/*=========================================================================*/
+typedef struct sQMIDev
+{
+   /* Device number */
+   dev_t                      mDevNum;
+
+   /* Device class */
+   struct class *             mpDevClass;
+
+   /* cdev struct */
+   struct cdev                mCdev;
+
+   /* is mCdev initialized? */
+   bool                       mbCdevIsInitialized;
+
+   /* Pointer to read URB */
+   struct urb *               mpReadURB;
+
+//#define READ_QMI_URB_ERROR
+#ifdef READ_QMI_URB_ERROR
+   struct timer_list mReadUrbTimer;
+#endif
+
+   /* Read setup packet */
+   sURBSetupPacket *          mpReadSetupPacket;
+
+   /* Read buffer attached to current read URB */
+   void *                     mpReadBuffer;
+   
+   /* Inturrupt URB */
+   /*    Used to asynchronously notify when read data is available */
+   struct urb *               mpIntURB;
+
+   /* Buffer used by Inturrupt URB */
+   void *                     mpIntBuffer;
+   
+   /* Pointer to memory linked list for all clients */
+   sClientMemList *           mpClientMemList;
+   
+   /* Spinlock for client Memory entries */
+   spinlock_t                 mClientMemLock;
+
+   /* Transaction ID associated with QMICTL "client" */
+   atomic_t                   mQMICTLTransactionID;
+
+} sQMIDev;
+
+/*=========================================================================*/
+// Struct sGobiUSBNet
+//
+//    Structure that defines the data associated with the Qualcomm USB device
+/*=========================================================================*/
+typedef struct sGobiUSBNet
+{
+    atomic_t refcount;
+
+   /* Net device structure */
+   struct usbnet *        mpNetDev;
+
+#if 1 //def DATA_MODE_RP
+    bool                   mbMdm9x07;  
+   /* QMI "device" work in IP Mode or ETH Mode */
+   bool                   mbRawIPMode;
+#endif
+
+   struct completion mQMIReadyCompletion;
+   bool                   mbQMIReady;
+
+   /* Usb device interface */
+   struct usb_interface * mpIntf;
+
+   /* Pointers to usbnet_open and usbnet_stop functions */
+   int                  (* mpUSBNetOpen)(struct net_device *);
+   int                  (* mpUSBNetStop)(struct net_device *);
+   
+   /* Reason(s) why interface is down */
+   /* Used by Gobi*DownReason */
+   unsigned long          mDownReason;
+#define NO_NDIS_CONNECTION    0
+#define CDC_CONNECTION_SPEED  1
+#define DRIVER_SUSPENDED      2
+#define NET_IFACE_STOPPED     3
+
+   /* QMI "device" status */
+   bool                   mbQMIValid;
+
+   bool                   mbDeregisterQMIDevice;
+
+   /* QMI "device" memory */
+   sQMIDev                mQMIDev;
+
+   /* Device MEID */
+   char                   mMEID[14];
+   
+#ifdef CONFIG_PM
+   #if (LINUX_VERSION_CODE < KERNEL_VERSION( 2,6,29 ))   
+   /* AutoPM thread */
+   sAutoPM                mAutoPM;
+#endif
+#endif /* CONFIG_PM */
+} sGobiUSBNet;
+
+/*=========================================================================*/
+// Struct sQMIFilpStorage
+//
+//    Structure that defines the storage each file handle contains
+//       Relates the file handle to a client
+/*=========================================================================*/
+typedef struct sQMIFilpStorage
+{
+   /* Client ID */
+   u16                  mClientID;
+   
+   /* Device pointer */
+   sGobiUSBNet *        mpDev;
+
+} sQMIFilpStorage;
+

root/package/link4all/gobinet/src/Makefile

@@ -0,0 +1,30 @@
+obj-m := GobiNet.o
+GobiNet-objs := GobiUSBNet.o QMIDevice.o QMI.o
+
+PWD := $(shell pwd)
+OUTPUTDIR=/lib/modules/`uname -r`/kernel/drivers/net/usb/
+
+ifeq ($(ARCH),)
+ARCH := $(shell uname -m)
+endif
+ifeq ($(CROSS_COMPILE),)
+CROSS_COMPILE :=
+endif
+ifeq ($(KDIR),)
+KDIR := /lib/modules/$(shell uname -r)/build
+endif
+
+default:
+	ln -sf makefile Makefile
+	$(MAKE) ARCH=${ARCH} CROSS_COMPILE=${CROSS_COMPILE} -C $(KDIR) M=$(PWD) modules
+
+install: default
+	mkdir -p $(OUTPUTDIR)
+	cp -f GobiNet.ko $(OUTPUTDIR)
+	depmod
+	modprobe -r GobiNet
+	modprobe GobiNet
+
+clean:
+	rm -rf Makefile
+	rm -rf *.o *~ core .depend .*.cmd *.ko *.mod.c .tmp_versions Module.* modules.order

root/package/link4all/gobinet/src/QMI.h

@@ -0,0 +1,314 @@
+/*===========================================================================
+FILE:
+   QMI.h
+
+DESCRIPTION:
+   Qualcomm QMI driver header
+   
+FUNCTIONS:
+   Generic QMUX functions
+      ParseQMUX
+      FillQMUX
+   
+   Generic QMI functions
+      GetTLV
+      ValidQMIMessage
+      GetQMIMessageID
+
+   Get sizes of buffers needed by QMI requests
+      QMUXHeaderSize
+      QMICTLGetClientIDReqSize
+      QMICTLReleaseClientIDReqSize
+      QMICTLReadyReqSize
+      QMIWDSSetEventReportReqSize
+      QMIWDSGetPKGSRVCStatusReqSize
+      QMIDMSGetMEIDReqSize
+      QMICTLSyncReqSize
+
+   Fill Buffers with QMI requests
+      QMICTLGetClientIDReq
+      QMICTLReleaseClientIDReq
+      QMICTLReadyReq
+      QMIWDSSetEventReportReq
+      QMIWDSGetPKGSRVCStatusReq
+      QMIDMSGetMEIDReq
+      QMICTLSetDataFormatReq
+      QMICTLSyncReq
+      
+   Parse data from QMI responses
+      QMICTLGetClientIDResp
+      QMICTLReleaseClientIDResp
+      QMIWDSEventResp
+      QMIDMSGetMEIDResp
+
+Copyright (c) 2011, Code Aurora Forum. All rights reserved.
+
+Redistribution and use in source and binary forms, with or without
+modification, are permitted provided that the following conditions are met:
+    * Redistributions of source code must retain the above copyright
+      notice, this list of conditions and the following disclaimer.
+    * Redistributions in binary form must reproduce the above copyright
+      notice, this list of conditions and the following disclaimer in the
+      documentation and/or other materials provided with the distribution.
+    * Neither the name of Code Aurora Forum nor
+      the names of its contributors may be used to endorse or promote
+      products derived from this software without specific prior written
+      permission.
+
+
+THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
+ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
+LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
+CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
+SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
+INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
+CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
+ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
+POSSIBILITY OF SUCH DAMAGE.
+===========================================================================*/
+
+#pragma once
+
+/*=========================================================================*/
+// Definitions
+/*=========================================================================*/
+
+extern int debug;
+// DBG macro
+#define DBG( format, arg... ) do { \
+   if (debug == 1)\
+   { \
+      printk( KERN_INFO "GobiNet::%s " format, __FUNCTION__, ## arg ); \
+   } }while(0)
+
+#if 0
+#define VDBG( format, arg... ) do { \
+   if (debug == 1)\
+   { \
+      printk( KERN_INFO "GobiNet::%s " format, __FUNCTION__, ## arg ); \
+   } } while(0)
+#else
+#define VDBG( format, arg... ) do { } while(0)
+#endif
+
+// QMI Service Types
+#define QMICTL 0
+#define QMIWDS 1
+#define QMIDMS 2
+#define QMIWDA 0x1A
+
+#define u8        unsigned char
+#define u16       unsigned short
+#define u32       unsigned int
+#define u64       unsigned long long
+
+#define bool      u8
+#define true      1
+#define false     0
+
+#define ENOMEM    12
+#define EFAULT    14
+#define EINVAL    22
+#ifndef ENOMSG
+#define ENOMSG    42
+#endif
+#define ENODATA   61
+
+#define TLV_TYPE_LINK_PROTO 0x10
+
+/*=========================================================================*/
+// Struct sQMUX
+//
+//    Structure that defines a QMUX header
+/*=========================================================================*/
+typedef struct sQMUX
+{
+   /* T\F, always 1 */
+   u8         mTF;
+
+   /* Size of message */
+   u16        mLength;
+
+   /* Control flag */
+   u8         mCtrlFlag;
+   
+   /* Service Type */
+   u8         mQMIService;
+   
+   /* Client ID */
+   u8         mQMIClientID;
+
+}__attribute__((__packed__)) sQMUX;
+
+/*=========================================================================*/
+// Generic QMUX functions
+/*=========================================================================*/
+
+// Remove QMUX headers from a buffer
+int ParseQMUX(
+   u16 *    pClientID,
+   void *   pBuffer,
+   u16      buffSize );
+
+// Fill buffer with QMUX headers
+int FillQMUX(
+   u16      clientID,
+   void *   pBuffer,
+   u16      buffSize );
+
+/*=========================================================================*/
+// Generic QMI functions
+/*=========================================================================*/
+
+// Get data buffer of a specified TLV from a QMI message
+int GetTLV(
+   void *   pQMIMessage,
+   u16      messageLen,
+   u8       type,
+   void *   pOutDataBuf,
+   u16      bufferLen );
+
+// Check mandatory TLV in a QMI message
+int ValidQMIMessage(
+   void *   pQMIMessage,
+   u16      messageLen );
+
+// Get the message ID of a QMI message
+int GetQMIMessageID(
+   void *   pQMIMessage,
+   u16      messageLen );
+
+/*=========================================================================*/
+// Get sizes of buffers needed by QMI requests
+/*=========================================================================*/
+
+// Get size of buffer needed for QMUX
+u16 QMUXHeaderSize( void );
+
+// Get size of buffer needed for QMUX + QMICTLGetClientIDReq
+u16 QMICTLGetClientIDReqSize( void );
+
+// Get size of buffer needed for QMUX + QMICTLReleaseClientIDReq
+u16 QMICTLReleaseClientIDReqSize( void );
+
+// Get size of buffer needed for QMUX + QMICTLReadyReq
+u16 QMICTLReadyReqSize( void );
+
+// Get size of buffer needed for QMUX + QMIWDSSetEventReportReq
+u16 QMIWDSSetEventReportReqSize( void );
+
+// Get size of buffer needed for QMUX + QMIWDSGetPKGSRVCStatusReq
+u16 QMIWDSGetPKGSRVCStatusReqSize( void );
+
+// Get size of buffer needed for QMUX + QMIDMSGetMEIDReq
+u16 QMIDMSGetMEIDReqSize( void );
+
+// Get size of buffer needed for QMUX + QMIWDASetDataFormatReq
+u16 QMIWDASetDataFormatReqSize( void );
+
+// Get size of buffer needed for QMUX + QMICTLSyncReq
+u16 QMICTLSyncReqSize( void );
+
+/*=========================================================================*/
+// Fill Buffers with QMI requests
+/*=========================================================================*/
+
+// Fill buffer with QMI CTL Get Client ID Request
+int QMICTLGetClientIDReq(
+   void *   pBuffer,
+   u16      buffSize,
+   u8       transactionID,
+   u8       serviceType );
+
+// Fill buffer with QMI CTL Release Client ID Request
+int QMICTLReleaseClientIDReq(
+   void *   pBuffer,
+   u16      buffSize,
+   u8       transactionID,
+   u16      clientID );
+
+// Fill buffer with QMI CTL Get Version Info Request
+int QMICTLReadyReq(
+   void *   pBuffer,
+   u16      buffSize,
+   u8       transactionID );
+
+// Fill buffer with QMI WDS Set Event Report Request
+int QMIWDSSetEventReportReq(
+   void *   pBuffer,
+   u16      buffSize,
+   u16      transactionID );
+
+// Fill buffer with QMI WDS Get PKG SRVC Status Request
+int QMIWDSGetPKGSRVCStatusReq(
+   void *   pBuffer,
+   u16      buffSize,
+   u16      transactionID );
+
+// Fill buffer with QMI DMS Get Serial Numbers Request
+int QMIDMSGetMEIDReq(
+   void *   pBuffer,
+   u16      buffSize,
+   u16      transactionID );
+
+// Fill buffer with QMI WDA Set Data Format Request
+int QMIWDASetDataFormatReq(
+   void *   pBuffer,
+   u16      buffSize,
+   u16      transactionID );
+
+int QMICTLSyncReq(
+   void *   pBuffer,
+   u16      buffSize,
+   u16      transactionID );
+
+/*=========================================================================*/
+// Parse data from QMI responses
+/*=========================================================================*/
+
+// Parse the QMI CTL Get Client ID Resp
+int QMICTLGetClientIDResp(
+   void * pBuffer,
+   u16    buffSize,
+   u16 *  pClientID );
+
+// Verify the QMI CTL Release Client ID Resp is valid
+int QMICTLReleaseClientIDResp(
+   void *   pBuffer,
+   u16      buffSize );
+
+// Parse the QMI WDS Set Event Report Resp/Indication or
+//    QMI WDS Get PKG SRVC Status Resp/Indication
+int QMIWDSEventResp(
+   void *   pBuffer,
+   u16      buffSize,
+   u32 *    pTXOk,
+   u32 *    pRXOk,
+   u32 *    pTXErr,
+   u32 *    pRXErr,
+   u32 *    pTXOfl,
+   u32 *    pRXOfl,
+   u64 *    pTXBytesOk,
+   u64 *    pRXBytesOk,
+   bool *   pbLinkState,
+   bool *   pbReconfigure );
+
+// Parse the QMI DMS Get Serial Numbers Resp
+int QMIDMSGetMEIDResp(
+   void *   pBuffer,
+   u16      buffSize,
+   char *   pMEID,
+   int      meidSize );
+
+// Parse the QMI DMS Get Serial Numbers Resp
+int QMIWDASetDataFormatResp(
+   void *   pBuffer,
+   u16      buffSize );
+
+// Pasre the QMI CTL Sync Response
+int QMICTLSyncResp(
+   void *pBuffer,
+   u16  buffSize );
+

root/package/link4all/gobinet/src/QMIDevice.h

@@ -0,0 +1,345 @@
+/*===========================================================================
+FILE:
+   QMIDevice.h
+
+DESCRIPTION:
+   Functions related to the QMI interface device
+   
+FUNCTIONS:
+   Generic functions
+      IsDeviceValid
+      PrintHex
+      GobiSetDownReason
+      GobiClearDownReason
+      GobiTestDownReason
+
+   Driver level asynchronous read functions
+      ResubmitIntURB
+      ReadCallback
+      IntCallback
+      StartRead
+      KillRead
+
+   Internal read/write functions
+      ReadAsync
+      UpSem
+      ReadSync
+      WriteSyncCallback
+      WriteSync
+
+   Internal memory management functions
+      GetClientID
+      ReleaseClientID
+      FindClientMem
+      AddToReadMemList
+      PopFromReadMemList
+      AddToNotifyList
+      NotifyAndPopNotifyList
+      AddToURBList
+      PopFromURBList
+
+   Internal userspace wrapper functions
+      UserspaceunlockedIOCTL
+
+   Userspace wrappers
+      UserspaceOpen
+      UserspaceIOCTL
+      UserspaceClose
+      UserspaceRead
+      UserspaceWrite
+      UserspacePoll
+
+   Initializer and destructor
+      RegisterQMIDevice
+      DeregisterQMIDevice
+
+   Driver level client management
+      QMIReady
+      QMIWDSCallback
+      SetupQMIWDSCallback
+      QMIDMSGetMEID
+
+Copyright (c) 2011, Code Aurora Forum. All rights reserved.
+
+Redistribution and use in source and binary forms, with or without
+modification, are permitted provided that the following conditions are met:
+    * Redistributions of source code must retain the above copyright
+      notice, this list of conditions and the following disclaimer.
+    * Redistributions in binary form must reproduce the above copyright
+      notice, this list of conditions and the following disclaimer in the
+      documentation and/or other materials provided with the distribution.
+    * Neither the name of Code Aurora Forum nor
+      the names of its contributors may be used to endorse or promote
+      products derived from this software without specific prior written
+      permission.
+
+
+THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
+ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
+LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
+CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
+SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
+INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
+CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
+ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
+POSSIBILITY OF SUCH DAMAGE.
+===========================================================================*/
+
+//---------------------------------------------------------------------------
+// Pragmas
+//---------------------------------------------------------------------------
+#pragma once
+
+//---------------------------------------------------------------------------
+// Include Files
+//---------------------------------------------------------------------------
+#include "Structs.h"
+#include "QMI.h"
+
+/*=========================================================================*/
+// Generic functions
+/*=========================================================================*/
+
+// Basic test to see if device memory is valid
+bool IsDeviceValid( sGobiUSBNet * pDev );
+
+// Print Hex data, for debug purposes
+void PrintHex(
+   void *         pBuffer,
+   u16            bufSize );
+
+// Sets mDownReason and turns carrier off
+void GobiSetDownReason(
+   sGobiUSBNet *    pDev,
+   u8                 reason );
+
+// Clear mDownReason and may turn carrier on
+void GobiClearDownReason(
+   sGobiUSBNet *    pDev,
+   u8                 reason );
+
+// Tests mDownReason and returns whether reason is set
+bool GobiTestDownReason(
+   sGobiUSBNet *    pDev,
+   u8                 reason );
+
+/*=========================================================================*/
+// Driver level asynchronous read functions
+/*=========================================================================*/
+
+// Resubmit interrupt URB, re-using same values
+int ResubmitIntURB( struct urb * pIntURB );
+
+// Read callback
+//    Put the data in storage and notify anyone waiting for data
+#if (LINUX_VERSION_CODE > KERNEL_VERSION( 2,6,14 ))
+void ReadCallback( struct urb * pReadURB );
+#else
+void ReadCallback(struct urb *pReadURB, struct pt_regs *regs);
+#endif
+
+// Inturrupt callback
+//    Data is available, start a read URB
+#if (LINUX_VERSION_CODE > KERNEL_VERSION( 2,6,14 ))
+void IntCallback( struct urb * pIntURB );
+#else
+void IntCallback(struct urb *pIntURB, struct pt_regs *regs);
+#endif
+
+// Start continuous read "thread"
+int StartRead( sGobiUSBNet * pDev );
+
+// Kill continuous read "thread"
+void KillRead( sGobiUSBNet * pDev );
+
+/*=========================================================================*/
+// Internal read/write functions
+/*=========================================================================*/
+
+// Start asynchronous read
+//     Reading client's data store, not device
+int ReadAsync(
+   sGobiUSBNet *    pDev,
+   u16                clientID,
+   u16                transactionID,
+   void               (*pCallback)(sGobiUSBNet *, u16, void *),
+   void *             pData );
+
+// Notification function for synchronous read
+void UpSem( 
+   sGobiUSBNet *    pDev,
+   u16                clientID,
+   void *             pData );
+
+// Start synchronous read
+//     Reading client's data store, not device
+int ReadSync(
+   sGobiUSBNet *    pDev,
+   void **            ppOutBuffer,
+   u16                clientID,
+   u16                transactionID );
+
+// Write callback
+#if (LINUX_VERSION_CODE > KERNEL_VERSION( 2,6,14 ))
+void WriteSyncCallback( struct urb * pWriteURB );
+#else
+void WriteSyncCallback(struct urb *pWriteURB, struct pt_regs *regs);
+#endif
+
+// Start synchronous write
+int WriteSync(
+   sGobiUSBNet *    pDev,
+   char *             pInWriteBuffer,
+   int                size,
+   u16                clientID );
+
+/*=========================================================================*/
+// Internal memory management functions
+/*=========================================================================*/
+
+// Create client and allocate memory
+int GetClientID( 
+   sGobiUSBNet *      pDev,
+   u8                   serviceType );
+
+// Release client and free memory
+void ReleaseClientID(
+   sGobiUSBNet *      pDev,
+   u16                  clientID );
+
+// Find this client's memory
+sClientMemList * FindClientMem(
+   sGobiUSBNet *      pDev,
+   u16                  clientID );
+
+// Add Data to this client's ReadMem list
+bool AddToReadMemList( 
+   sGobiUSBNet *      pDev,
+   u16                  clientID,
+   u16                  transactionID,
+   void *               pData,
+   u16                  dataSize );
+
+// Remove data from this client's ReadMem list if it matches 
+// the specified transaction ID.
+bool PopFromReadMemList( 
+   sGobiUSBNet *      pDev,
+   u16                  clientID,
+   u16                  transactionID,
+   void **              ppData,
+   u16 *                pDataSize );
+
+// Add Notify entry to this client's notify List
+bool AddToNotifyList( 
+   sGobiUSBNet *      pDev,
+   u16                  clientID,
+   u16                  transactionID,
+   void                 (* pNotifyFunct)(sGobiUSBNet *, u16, void *),
+   void *               pData );
+
+// Remove first Notify entry from this client's notify list 
+//    and Run function
+bool NotifyAndPopNotifyList( 
+   sGobiUSBNet *      pDev,
+   u16                  clientID,
+   u16                  transactionID );
+
+// Add URB to this client's URB list
+bool AddToURBList( 
+   sGobiUSBNet *      pDev,
+   u16                  clientID,
+   struct urb *         pURB );
+
+// Remove URB from this client's URB list
+struct urb * PopFromURBList( 
+   sGobiUSBNet *      pDev,
+   u16                  clientID );
+
+/*=========================================================================*/
+// Internal userspace wrappers
+/*=========================================================================*/
+
+// Userspace unlocked ioctl
+long UserspaceunlockedIOCTL(
+   struct file *     pFilp,
+   unsigned int      cmd,
+   unsigned long     arg );
+
+/*=========================================================================*/
+// Userspace wrappers
+/*=========================================================================*/
+
+// Userspace open
+int UserspaceOpen( 
+   struct inode *   pInode, 
+   struct file *    pFilp );
+
+// Userspace ioctl
+int UserspaceIOCTL( 
+   struct inode *    pUnusedInode, 
+   struct file *     pFilp,
+   unsigned int      cmd, 
+   unsigned long     arg );
+
+// Userspace close
+#if (LINUX_VERSION_CODE > KERNEL_VERSION( 2,6,14 ))
+int UserspaceClose( 
+   struct file *       pFilp,
+   fl_owner_t          unusedFileTable );
+#else
+int UserspaceClose( struct file *       pFilp );
+#endif
+
+// Userspace read (synchronous)
+ssize_t UserspaceRead( 
+   struct file *        pFilp,
+   char __user *        pBuf, 
+   size_t               size,
+   loff_t *             pUnusedFpos );
+
+// Userspace write (synchronous)
+ssize_t UserspaceWrite(
+   struct file *        pFilp, 
+   const char __user *  pBuf, 
+   size_t               size,
+   loff_t *             pUnusedFpos );
+
+unsigned int UserspacePoll(
+   struct file *                  pFilp,
+   struct poll_table_struct *     pPollTable );
+
+/*=========================================================================*/
+// Initializer and destructor
+/*=========================================================================*/
+
+// QMI Device initialization function
+int RegisterQMIDevice( sGobiUSBNet * pDev );
+
+// QMI Device cleanup function
+void DeregisterQMIDevice( sGobiUSBNet * pDev );
+
+/*=========================================================================*/
+// Driver level client management
+/*=========================================================================*/
+
+// Check if QMI is ready for use
+bool QMIReady(
+   sGobiUSBNet *    pDev,
+   u16                timeout );
+
+// QMI WDS callback function
+void QMIWDSCallback(
+   sGobiUSBNet *    pDev,
+   u16                clientID,
+   void *             pData );
+
+// Fire off reqests and start async read for QMI WDS callback
+int SetupQMIWDSCallback( sGobiUSBNet * pDev );
+
+// Register client, send req and parse MEID response, release client
+int QMIDMSGetMEID( sGobiUSBNet * pDev );
+
+// Register client, send req and parse Data format response, release client
+int QMIWDASetDataFormat( sGobiUSBNet * pDev );

root/package/link4all/gobinet/src/Structs.h

@@ -0,0 +1,423 @@
+/*===========================================================================
+FILE:
+   Structs.h
+
+DESCRIPTION:
+   Declaration of structures used by the Qualcomm Linux USB Network driver
+   
+FUNCTIONS:
+   none
+
+Copyright (c) 2011, Code Aurora Forum. All rights reserved.
+
+Redistribution and use in source and binary forms, with or without
+modification, are permitted provided that the following conditions are met:
+    * Redistributions of source code must retain the above copyright
+      notice, this list of conditions and the following disclaimer.
+    * Redistributions in binary form must reproduce the above copyright
+      notice, this list of conditions and the following disclaimer in the
+      documentation and/or other materials provided with the distribution.
+    * Neither the name of Code Aurora Forum nor
+      the names of its contributors may be used to endorse or promote
+      products derived from this software without specific prior written
+      permission.
+
+
+THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
+ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
+LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
+CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
+SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
+INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
+CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
+ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
+POSSIBILITY OF SUCH DAMAGE.
+===========================================================================*/
+
+//---------------------------------------------------------------------------
+// Pragmas
+//---------------------------------------------------------------------------
+#pragma once
+
+//---------------------------------------------------------------------------
+// Include Files
+//---------------------------------------------------------------------------
+#include <linux/etherdevice.h>
+#include <linux/ethtool.h>
+#include <linux/mii.h>
+#include <linux/usb.h>
+#include <linux/version.h>
+#include <linux/cdev.h>
+#include <linux/kthread.h>
+#include <linux/poll.h>
+#include <linux/completion.h>
+
+#if (LINUX_VERSION_CODE <= KERNEL_VERSION( 2,6,22 ))
+#define bool      u8
+#define URB_FREE_BUFFER		0x0100	/* Free transfer buffer with the URB */
+
+/**
+ * usb_endpoint_type - get the endpoint's transfer type
+ * @epd: endpoint to be checked
+ *
+ * Returns one of USB_ENDPOINT_XFER_{CONTROL, ISOC, BULK, INT} according
+ * to @epd's transfer type.
+ */
+static inline int usb_endpoint_type(const struct usb_endpoint_descriptor *epd)
+{
+	return epd->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK;
+}
+#endif
+
+#if (LINUX_VERSION_CODE <= KERNEL_VERSION( 2,6,14 ))
+/**
+ * usb_endpoint_dir_in - check if the endpoint has IN direction
+ * @epd: endpoint to be checked
+ *
+ * Returns true if the endpoint is of type IN, otherwise it returns false.
+ */
+static inline int usb_endpoint_dir_in(const struct usb_endpoint_descriptor *epd)
+{
+	return ((epd->bEndpointAddress & USB_ENDPOINT_DIR_MASK) == USB_DIR_IN);
+}
+
+/**
+ * usb_endpoint_dir_out - check if the endpoint has OUT direction
+ * @epd: endpoint to be checked
+ *
+ * Returns true if the endpoint is of type OUT, otherwise it returns false.
+ */
+static inline int usb_endpoint_dir_out(
+				const struct usb_endpoint_descriptor *epd)
+{
+	return ((epd->bEndpointAddress & USB_ENDPOINT_DIR_MASK) == USB_DIR_OUT);
+}
+
+/**
+ * usb_endpoint_xfer_int - check if the endpoint has interrupt transfer type
+ * @epd: endpoint to be checked
+ *
+ * Returns true if the endpoint is of type interrupt, otherwise it returns
+ * false.
+ */
+static inline int usb_endpoint_xfer_int(
+				const struct usb_endpoint_descriptor *epd)
+{
+	return ((epd->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK) ==
+		USB_ENDPOINT_XFER_INT);
+}
+
+static inline int usb_autopm_set_interface(struct usb_interface *intf)
+{ return 0; }
+
+static inline int usb_autopm_get_interface(struct usb_interface *intf)
+{ return 0; }
+
+static inline int usb_autopm_get_interface_async(struct usb_interface *intf)
+{ return 0; }
+
+static inline void usb_autopm_put_interface(struct usb_interface *intf)
+{ }
+static inline void usb_autopm_put_interface_async(struct usb_interface *intf)
+{ }
+static inline void usb_autopm_enable(struct usb_interface *intf)
+{ }
+static inline void usb_autopm_disable(struct usb_interface *intf)
+{ }
+static inline void usb_mark_last_busy(struct usb_device *udev)
+{ }
+#endif
+
+#if (LINUX_VERSION_CODE <= KERNEL_VERSION( 2,6,24 ))
+   #include "usbnet.h"
+#else
+   #include <linux/usb/usbnet.h>
+#endif
+
+#if (LINUX_VERSION_CODE > KERNEL_VERSION( 2,6,25 ))
+   #include <linux/fdtable.h>
+#else
+   #include <linux/file.h>
+#endif
+
+// Used in recursion, defined later below
+struct sGobiUSBNet;
+
+/*=========================================================================*/
+// Struct sReadMemList
+//
+//    Structure that defines an entry in a Read Memory linked list
+/*=========================================================================*/
+typedef struct sReadMemList
+{
+   /* Data buffer */
+   void *                     mpData;
+   
+   /* Transaction ID */
+   u16                        mTransactionID;
+
+   /* Size of data buffer */
+   u16                        mDataSize;
+
+   /* Next entry in linked list */
+   struct sReadMemList *      mpNext;
+
+} sReadMemList;
+
+/*=========================================================================*/
+// Struct sNotifyList
+//
+//    Structure that defines an entry in a Notification linked list
+/*=========================================================================*/
+typedef struct sNotifyList
+{
+   /* Function to be run when data becomes available */
+   void                  (* mpNotifyFunct)(struct sGobiUSBNet *, u16, void *);
+   
+   /* Transaction ID */
+   u16                   mTransactionID;
+
+   /* Data to provide as parameter to mpNotifyFunct */
+   void *                mpData;
+   
+   /* Next entry in linked list */
+   struct sNotifyList *  mpNext;
+
+} sNotifyList;
+
+/*=========================================================================*/
+// Struct sURBList
+//
+//    Structure that defines an entry in a URB linked list
+/*=========================================================================*/
+typedef struct sURBList
+{
+   /* The current URB */
+   struct urb *       mpURB;
+
+   /* Next entry in linked list */
+   struct sURBList *  mpNext;
+
+} sURBList;
+
+/*=========================================================================*/
+// Struct sClientMemList
+//
+//    Structure that defines an entry in a Client Memory linked list
+//      Stores data specific to a Service Type and Client ID
+/*=========================================================================*/
+typedef struct sClientMemList
+{
+   /* Client ID for this Client */
+   u16                          mClientID;
+
+   /* Linked list of Read entries */
+   /*    Stores data read from device before sending to client */
+   sReadMemList *               mpList;
+   
+   /* Linked list of Notification entries */
+   /*    Stores notification functions to be run as data becomes 
+         available or the device is removed */
+   sNotifyList *                mpReadNotifyList;
+
+   /* Linked list of URB entries */
+   /*    Stores pointers to outstanding URBs which need canceled 
+         when the client is deregistered or the device is removed */
+   sURBList *                   mpURBList;
+   
+   /* Next entry in linked list */
+   struct sClientMemList *      mpNext;
+
+   /* Wait queue object for poll() */
+   wait_queue_head_t    mWaitQueue;
+
+} sClientMemList;
+
+/*=========================================================================*/
+// Struct sURBSetupPacket
+//
+//    Structure that defines a USB Setup packet for Control URBs
+//    Taken from USB CDC specifications
+/*=========================================================================*/
+typedef struct sURBSetupPacket
+{
+   /* Request type */
+   u8    mRequestType;
+
+   /* Request code */
+   u8    mRequestCode;
+
+   /* Value */
+   u16   mValue;
+
+   /* Index */
+   u16   mIndex;
+
+   /* Length of Control URB */
+   u16   mLength;
+
+} sURBSetupPacket;
+
+// Common value for sURBSetupPacket.mLength
+#define DEFAULT_READ_URB_LENGTH 0x1000
+
+#ifdef CONFIG_PM
+#if (LINUX_VERSION_CODE < KERNEL_VERSION( 2,6,29 ))
+/*=========================================================================*/
+// Struct sAutoPM
+//
+//    Structure used to manage AutoPM thread which determines whether the
+//    device is in use or may enter autosuspend.  Also submits net 
+//    transmissions asynchronously.
+/*=========================================================================*/
+typedef struct sAutoPM
+{
+   /* Thread for atomic autopm function */
+   struct task_struct *       mpThread;
+
+   /* Signal for completion when it's time for the thread to work */
+   struct completion          mThreadDoWork;
+
+   /* Time to exit? */
+   bool                       mbExit;
+
+   /* List of URB's queued to be sent to the device */
+   sURBList *                 mpURBList;
+
+   /* URB list lock (for adding and removing elements) */
+   spinlock_t                 mURBListLock;
+
+   /* Length of the URB list */
+   atomic_t                   mURBListLen;
+   
+   /* Active URB */
+   struct urb *               mpActiveURB;
+
+   /* Active URB lock (for adding and removing elements) */
+   spinlock_t                 mActiveURBLock;
+   
+   /* Duplicate pointer to USB device interface */
+   struct usb_interface *     mpIntf;
+
+} sAutoPM;
+#endif
+#endif /* CONFIG_PM */
+
+/*=========================================================================*/
+// Struct sQMIDev
+//
+//    Structure that defines the data for the QMI device
+/*=========================================================================*/
+typedef struct sQMIDev
+{
+   /* Device number */
+   dev_t                      mDevNum;
+
+   /* Device class */
+   struct class *             mpDevClass;
+
+   /* cdev struct */
+   struct cdev                mCdev;
+
+   /* is mCdev initialized? */
+   bool                       mbCdevIsInitialized;
+
+   /* Pointer to read URB */
+   struct urb *               mpReadURB;
+
+   /* Read setup packet */
+   sURBSetupPacket *          mpReadSetupPacket;
+
+   /* Read buffer attached to current read URB */
+   void *                     mpReadBuffer;
+   
+   /* Inturrupt URB */
+   /*    Used to asynchronously notify when read data is available */
+   struct urb *               mpIntURB;
+
+   /* Buffer used by Inturrupt URB */
+   void *                     mpIntBuffer;
+   
+   /* Pointer to memory linked list for all clients */
+   sClientMemList *           mpClientMemList;
+   
+   /* Spinlock for client Memory entries */
+   spinlock_t                 mClientMemLock;
+
+   /* Transaction ID associated with QMICTL "client" */
+   atomic_t                   mQMICTLTransactionID;
+
+} sQMIDev;
+
+/*=========================================================================*/
+// Struct sGobiUSBNet
+//
+//    Structure that defines the data associated with the Qualcomm USB device
+/*=========================================================================*/
+typedef struct sGobiUSBNet
+{
+    atomic_t refcount;
+
+   /* Net device structure */
+   struct usbnet *        mpNetDev;
+
+#if 1 //def DATA_MODE_RP
+   /* QMI "device" work in IP Mode or ETH Mode */
+   bool                   mbRawIPMode;
+#endif
+
+   struct completion mQMIReadyCompletion;
+   bool                   mbQMIReady;
+
+   /* Usb device interface */
+   struct usb_interface * mpIntf;
+
+   /* Pointers to usbnet_open and usbnet_stop functions */
+   int                  (* mpUSBNetOpen)(struct net_device *);
+   int                  (* mpUSBNetStop)(struct net_device *);
+   
+   /* Reason(s) why interface is down */
+   /* Used by Gobi*DownReason */
+   unsigned long          mDownReason;
+#define NO_NDIS_CONNECTION    0
+#define CDC_CONNECTION_SPEED  1
+#define DRIVER_SUSPENDED      2
+#define NET_IFACE_STOPPED     3
+
+   /* QMI "device" status */
+   bool                   mbQMIValid;
+
+   bool                   mbDeregisterQMIDevice;
+
+   /* QMI "device" memory */
+   sQMIDev                mQMIDev;
+
+   /* Device MEID */
+   char                   mMEID[14];
+   
+#ifdef CONFIG_PM
+   #if (LINUX_VERSION_CODE < KERNEL_VERSION( 2,6,29 ))   
+   /* AutoPM thread */
+   sAutoPM                mAutoPM;
+#endif
+#endif /* CONFIG_PM */
+} sGobiUSBNet;
+
+/*=========================================================================*/
+// Struct sQMIFilpStorage
+//
+//    Structure that defines the storage each file handle contains
+//       Relates the file handle to a client
+/*=========================================================================*/
+typedef struct sQMIFilpStorage
+{
+   /* Client ID */
+   u16                  mClientID;
+   
+   /* Device pointer */
+   sGobiUSBNet *        mpDev;
+
+} sQMIFilpStorage;
+

root/package/link4all/gobinet_srm815/Makefile

@@ -0,0 +1,54 @@
+#
+# Copyright (c) 2014 The Linux Foundation. All rights reserved.
+#
+
+include $(TOPDIR)/rules.mk
+include $(INCLUDE_DIR)/kernel.mk
+
+PKG_NAME:=srm815
+PKG_VERSION:=2011-07-29-1026
+PKG_RELEASE:=1
+
+
+PKG_BUILD_DIR:=$(KERNEL_BUILD_DIR)/$(PKG_NAME)
+
+include $(INCLUDE_DIR)/package.mk
+
+define KernelPackage/srm815
+  CATEGORY:=LINK4ALL
+  DEPENDS:=+kmod-usb-net
+  TITLE:=srm815
+  FILES:= $(PKG_BUILD_DIR)/srm815.ko
+  AUTOLOAD:=$(call AutoLoad,81,srm815)
+endef
+
+define KernelPackage/srm815/Description
+driver for meige srm815 5g modem
+endef
+
+define Build/Prepare
+	$(CP) src/* $(PKG_BUILD_DIR)
+	$(call Build/Prepare/Default)
+endef
+
+# define Build/Compile
+# 	$(MAKE) -C "$(LINUX_DIR)" \
+# 		CROSS_COMPILE="$(TARGET_CROSS)" \
+# 		ARCH="$(LINUX_KARCH)" \
+# 		SUBDIRS="$(PKG_BUILD_DIR)" \
+# 		EXTRA_CFLAGS="$(EXTRA_CFLAGS)" \
+# 		modules
+# endef
+
+MAKE_OPTS:= \
+	$(KERNEL_MAKE_FLAGS) \
+	M="$(PKG_BUILD_DIR)"
+
+define Build/Compile
+	$(MAKE) -C "$(LINUX_DIR)" \
+		$(MAKE_OPTS) \
+		modules
+endef
+
+$(eval $(call KernelPackage,srm815))
+

root/package/link4all/gobinet_srm815/patches00/gobinet-4.19.patch

@@ -0,0 +1,14 @@
+Index: QMIDevice.c
+===================================================================
+--- a/QMIDevice.c
++++ b/QMIDevice.c
+@@ -3382,7 +3382,8 @@ void DeregisterQMIDevice( sGobiUSBNet *
+    // but exists to prevent an infinate loop just in case.
+    for (tries = 0; tries < 30 * 100; tries++)
+    {
+-      int ref = atomic_read( &pDev->mQMIDev.mCdev.kobj.kref.refcount );
++      //int ref = atomic_read( &pDev->mQMIDev.mCdev.kobj.kref.refcount );
++      int ref = refcount_read( &pDev->mQMIDev.mCdev.kobj.kref.refcount );
+       if (ref > 1)
+       {
+          DBG( "cdev in use by %d tasks\n", ref - 1 ); 

root/package/link4all/gobinet_srm815/src.old/Makefile

@@ -0,0 +1,30 @@
+obj-m := srm815.o
+srm815-objs := GobiUSBNet.o QMIDevice.o QMI.o
+
+PWD := $(shell pwd)
+OUTPUTDIR=/lib/modules/`uname -r`/kernel/drivers/net/usb/
+
+ifeq ($(ARCH),)
+ARCH := $(shell uname -m)
+endif
+ifeq ($(CROSS_COMPILE),)
+CROSS_COMPILE :=
+endif
+ifeq ($(KDIR),)
+KDIR := /lib/modules/$(shell uname -r)/build
+endif
+
+default:
+	ln -sf makefile Makefile
+	$(MAKE) ARCH=${ARCH} CROSS_COMPILE=${CROSS_COMPILE} -C $(KDIR) M=$(PWD) modules
+
+install: default
+	mkdir -p $(OUTPUTDIR)
+	cp -f srm815.ko $(OUTPUTDIR)
+	depmod
+	modprobe -r srm815
+	modprobe srm815
+
+clean:
+	rm -rf Makefile
+	rm -rf *.o *~ core .depend .*.cmd *.ko *.mod.c .tmp_versions Module.* modules.order

root/package/link4all/gobinet_srm815/src.old/QMI.h

@@ -0,0 +1,337 @@
+/*===========================================================================
+FILE:
+   QMI.h
+
+DESCRIPTION:
+   Qualcomm QMI driver header
+
+FUNCTIONS:
+   Generic QMUX functions
+      ParseQMUX
+      FillQMUX
+
+   Generic QMI functions
+      GetTLV
+      ValidQMIMessage
+      GetQMIMessageID
+
+   Get sizes of buffers needed by QMI requests
+      QMUXHeaderSize
+      QMICTLGetClientIDReqSize
+      QMICTLReleaseClientIDReqSize
+      QMICTLReadyReqSize
+      QMIWDSSetEventReportReqSize
+      QMIWDSGetPKGSRVCStatusReqSize
+      QMIDMSGetMEIDReqSize
+      QMICTLSyncReqSize
+
+   Fill Buffers with QMI requests
+      QMICTLGetClientIDReq
+      QMICTLReleaseClientIDReq
+      QMICTLReadyReq
+      QMIWDSSetEventReportReq
+      QMIWDSGetPKGSRVCStatusReq
+      QMIDMSGetMEIDReq
+      QMICTLSetDataFormatReq
+      QMICTLSyncReq
+
+   Parse data from QMI responses
+      QMICTLGetClientIDResp
+      QMICTLReleaseClientIDResp
+      QMIWDSEventResp
+      QMIDMSGetMEIDResp
+
+Copyright (c) 2011, Code Aurora Forum. All rights reserved.
+
+Redistribution and use in source and binary forms, with or without
+modification, are permitted provided that the following conditions are met:
+    * Redistributions of source code must retain the above copyright
+      notice, this list of conditions and the following disclaimer.
+    * Redistributions in binary form must reproduce the above copyright
+      notice, this list of conditions and the following disclaimer in the
+      documentation and/or other materials provided with the distribution.
+    * Neither the name of Code Aurora Forum nor
+      the names of its contributors may be used to endorse or promote
+      products derived from this software without specific prior written
+      permission.
+
+
+THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
+ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
+LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
+CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
+SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
+INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
+CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
+ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
+POSSIBILITY OF SUCH DAMAGE.
+===========================================================================*/
+
+#pragma once
+
+/*=========================================================================*/
+// Definitions
+/*=========================================================================*/
+
+extern int meig_debug;
+// DBG macro
+#define DBG( format, arg... ) do { \
+   if (meig_debug == 1)\
+   { \
+      printk( KERN_INFO "GobiNet::%s " format, __FUNCTION__, ## arg ); \
+   } }while(0)
+
+#if 0
+#define VDBG( format, arg... ) do { \
+   if (debug == 1)\
+   { \
+      printk( KERN_INFO "GobiNet::%s " format, __FUNCTION__, ## arg ); \
+   } } while(0)
+#else
+#define VDBG( format, arg... ) do { } while(0)
+#endif
+
+#define INFO( format, arg... ) do { \
+      printk( KERN_INFO "GobiNet::%s " format, __FUNCTION__, ## arg ); \
+   }while(0)
+
+// QMI Service Types
+#define QMICTL 0
+#define QMIWDS 1
+#define QMIDMS 2
+#define QMINAS 3
+#define QMIUIM 11
+#define QMIWDA 0x1A
+
+#define u8        unsigned char
+#define u16       unsigned short
+#define u32       unsigned int
+#define u64       unsigned long long
+
+#define bool      u8
+#define true      1
+#define false     0
+
+#define ENOMEM    12
+#define EFAULT    14
+#define EINVAL    22
+#ifndef ENOMSG
+#define ENOMSG    42
+#endif
+#define ENODATA   61
+
+#define TLV_TYPE_LINK_PROTO 0x10
+
+/*=========================================================================*/
+// Struct sQMUX
+//
+//    Structure that defines a QMUX header
+/*=========================================================================*/
+typedef struct sQMUX {
+    /* T\F, always 1 */
+    u8         mTF;
+
+    /* Size of message */
+    u16        mLength;
+
+    /* Control flag */
+    u8         mCtrlFlag;
+
+    /* Service Type */
+    u8         mQMIService;
+
+    /* Client ID */
+    u8         mQMIClientID;
+
+} __attribute__((__packed__)) sQMUX;
+
+#if 0
+/*=========================================================================*/
+// Generic QMUX functions
+/*=========================================================================*/
+
+// Remove QMUX headers from a buffer
+int ParseQMUX(
+    u16 *    pClientID,
+    void *   pBuffer,
+    u16      buffSize );
+
+// Fill buffer with QMUX headers
+int FillQMUX(
+    u16      clientID,
+    void *   pBuffer,
+    u16      buffSize );
+
+/*=========================================================================*/
+// Generic QMI functions
+/*=========================================================================*/
+
+// Get data buffer of a specified TLV from a QMI message
+int GetTLV(
+    void *   pQMIMessage,
+    u16      messageLen,
+    u8       type,
+    void *   pOutDataBuf,
+    u16      bufferLen );
+
+// Check mandatory TLV in a QMI message
+int ValidQMIMessage(
+    void *   pQMIMessage,
+    u16      messageLen );
+
+// Get the message ID of a QMI message
+int GetQMIMessageID(
+    void *   pQMIMessage,
+    u16      messageLen );
+
+/*=========================================================================*/
+// Get sizes of buffers needed by QMI requests
+/*=========================================================================*/
+
+// Get size of buffer needed for QMUX
+u16 QMUXHeaderSize( void );
+
+// Get size of buffer needed for QMUX + QMICTLGetClientIDReq
+u16 QMICTLGetClientIDReqSize( void );
+
+// Get size of buffer needed for QMUX + QMICTLReleaseClientIDReq
+u16 QMICTLReleaseClientIDReqSize( void );
+
+// Get size of buffer needed for QMUX + QMICTLReadyReq
+u16 QMICTLReadyReqSize( void );
+
+// Get size of buffer needed for QMUX + QMIWDSSetEventReportReq
+u16 QMIWDSSetEventReportReqSize( void );
+
+// Get size of buffer needed for QMUX + QMIWDSGetPKGSRVCStatusReq
+u16 QMIWDSGetPKGSRVCStatusReqSize( void );
+
+u16 QMIWDSSetQMUXBindMuxDataPortSize( void );
+
+// Get size of buffer needed for QMUX + QMIDMSGetMEIDReq
+u16 QMIDMSGetMEIDReqSize( void );
+
+// Get size of buffer needed for QMUX + QMIWDASetDataFormatReq
+u16 QMIWDASetDataFormatReqSize( int qmap_mode );
+
+// Get size of buffer needed for QMUX + QMICTLSyncReq
+u16 QMICTLSyncReqSize( void );
+
+/*=========================================================================*/
+// Fill Buffers with QMI requests
+/*=========================================================================*/
+
+// Fill buffer with QMI CTL Get Client ID Request
+int QMICTLGetClientIDReq(
+    void *   pBuffer,
+    u16      buffSize,
+    u8       transactionID,
+    u8       serviceType );
+
+// Fill buffer with QMI CTL Release Client ID Request
+int QMICTLReleaseClientIDReq(
+    void *   pBuffer,
+    u16      buffSize,
+    u8       transactionID,
+    u16      clientID );
+
+// Fill buffer with QMI CTL Get Version Info Request
+int QMICTLReadyReq(
+    void *   pBuffer,
+    u16      buffSize,
+    u8       transactionID );
+
+// Fill buffer with QMI WDS Set Event Report Request
+int QMIWDSSetEventReportReq(
+    void *   pBuffer,
+    u16      buffSize,
+    u16      transactionID );
+
+// Fill buffer with QMI WDS Get PKG SRVC Status Request
+int QMIWDSGetPKGSRVCStatusReq(
+    void *   pBuffer,
+    u16      buffSize,
+    u16      transactionID );
+
+u16 QMIWDSSetQMUXBindMuxDataPortReq(
+    void *   pBuffer,
+    u16      buffSize,
+    u8 MuxId,
+    sGobiUSBNet * pDev, //add for net interface bond by zhaopf
+    u16      transactionID );
+
+// Fill buffer with QMI DMS Get Serial Numbers Request
+int QMIDMSGetMEIDReq(
+    void *   pBuffer,
+    u16      buffSize,
+    u16      transactionID );
+
+// Fill buffer with QMI WDA Set Data Format Request
+int QMIWDASetDataFormatReq(
+    void *   pBuffer,
+    u16      buffSize,
+    bool     bRawIPMode, int qmap_mode, u32 rx_size,
+    u16      transactionID );
+
+#if 0
+int QMIWDASetDataQmapReq(
+    void *   pBuffer,
+    u16      buffSize,
+    u16      transactionID );
+#endif
+
+int QMICTLSyncReq(
+    void *   pBuffer,
+    u16      buffSize,
+    u16      transactionID );
+
+/*=========================================================================*/
+// Parse data from QMI responses
+/*=========================================================================*/
+
+// Parse the QMI CTL Get Client ID Resp
+int QMICTLGetClientIDResp(
+    void * pBuffer,
+    u16    buffSize,
+    u16 *  pClientID );
+
+// Verify the QMI CTL Release Client ID Resp is valid
+int QMICTLReleaseClientIDResp(
+    void *   pBuffer,
+    u16      buffSize );
+
+// Parse the QMI WDS Set Event Report Resp/Indication or
+//    QMI WDS Get PKG SRVC Status Resp/Indication
+int QMIWDSEventResp(
+    void *   pBuffer,
+    u16      buffSize,
+    u32 *    pTXOk,
+    u32 *    pRXOk,
+    u32 *    pTXErr,
+    u32 *    pRXErr,
+    u32 *    pTXOfl,
+    u32 *    pRXOfl,
+    u64 *    pTXBytesOk,
+    u64 *    pRXBytesOk,
+    bool *   pbLinkState,
+    bool *   pbReconfigure );
+
+// Parse the QMI DMS Get Serial Numbers Resp
+int QMIDMSGetMEIDResp(
+    void *   pBuffer,
+    u16      buffSize,
+    char *   pMEID,
+    int      meidSize );
+
+// Parse the QMI DMS Get Serial Numbers Resp
+int QMIWDASetDataFormatResp(
+    void *   pBuffer,
+    u16      buffSize, bool bRawIPMode, int *qmap_enabled, int *rx_size, int *tx_size);
+
+// Pasre the QMI CTL Sync Response
+int QMICTLSyncResp(
+    void *pBuffer,
+    u16  buffSize );
+#endif

root/package/link4all/gobinet_srm815/src.old/QMIDevice.h

@@ -0,0 +1,368 @@
+/*===========================================================================
+FILE:
+   QMIDevice.h
+
+DESCRIPTION:
+   Functions related to the QMI interface device
+
+FUNCTIONS:
+   Generic functions
+      IsDeviceValid
+      PrintHex
+      GobiSetDownReason
+      GobiClearDownReason
+      GobiTestDownReason
+
+   Driver level asynchronous read functions
+      ResubmitIntURB
+      ReadCallback
+      IntCallback
+      StartRead
+      KillRead
+
+   Internal read/write functions
+      ReadAsync
+      UpSem
+      ReadSync
+      WriteSyncCallback
+      WriteSync
+
+   Internal memory management functions
+      GetClientID
+      ReleaseClientID
+      FindClientMem
+      AddToReadMemList
+      PopFromReadMemList
+      AddToNotifyList
+      NotifyAndPopNotifyList
+      AddToURBList
+      PopFromURBList
+
+   Internal userspace wrapper functions
+      UserspaceunlockedIOCTL
+
+   Userspace wrappers
+      UserspaceOpen
+      UserspaceIOCTL
+      UserspaceClose
+      UserspaceRead
+      UserspaceWrite
+      UserspacePoll
+
+   Initializer and destructor
+      RegisterQMIDevice
+      DeregisterQMIDevice
+
+   Driver level client management
+      QMIReady
+      QMIWDSCallback
+      SetupQMIWDSCallback
+      QMIDMSGetMEID
+
+Copyright (c) 2011, Code Aurora Forum. All rights reserved.
+
+Redistribution and use in source and binary forms, with or without
+modification, are permitted provided that the following conditions are met:
+    * Redistributions of source code must retain the above copyright
+      notice, this list of conditions and the following disclaimer.
+    * Redistributions in binary form must reproduce the above copyright
+      notice, this list of conditions and the following disclaimer in the
+      documentation and/or other materials provided with the distribution.
+    * Neither the name of Code Aurora Forum nor
+      the names of its contributors may be used to endorse or promote
+      products derived from this software without specific prior written
+      permission.
+
+
+THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
+ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
+LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
+CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
+SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
+INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
+CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
+ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
+POSSIBILITY OF SUCH DAMAGE.
+===========================================================================*/
+
+//---------------------------------------------------------------------------
+// Pragmas
+//---------------------------------------------------------------------------
+#pragma once
+
+//---------------------------------------------------------------------------
+// Include Files
+//---------------------------------------------------------------------------
+#include "Structs.h"
+#include "QMI.h"
+
+/*=========================================================================*/
+// Generic functions
+/*=========================================================================*/
+
+#ifdef __MEIG_INTER__
+
+// Basic test to see if device memory is valid
+static bool IsDeviceValid( sGobiUSBNet * pDev );
+
+/*=========================================================================*/
+// Driver level asynchronous read functions
+/*=========================================================================*/
+
+// Resubmit interrupt URB, re-using same values
+static int ResubmitIntURB( struct urb * pIntURB );
+
+// Read callback
+//    Put the data in storage and notify anyone waiting for data
+#if (LINUX_VERSION_CODE > KERNEL_VERSION( 2,6,18 ))
+static void ReadCallback( struct urb * pReadURB );
+#else
+static void ReadCallback(struct urb *pReadURB, struct pt_regs *regs);
+#endif
+
+// Inturrupt callback
+//    Data is available, start a read URB
+#if (LINUX_VERSION_CODE > KERNEL_VERSION( 2,6,18 ))
+static void IntCallback( struct urb * pIntURB );
+#else
+static void IntCallback(struct urb *pIntURB, struct pt_regs *regs);
+#endif
+
+/*=========================================================================*/
+// Internal read/write functions
+/*=========================================================================*/
+
+// Start asynchronous read
+//     Reading client's data store, not device
+static int ReadAsync(
+    sGobiUSBNet *    pDev,
+    u16                clientID,
+    u16                transactionID,
+    void               (*pCallback)(sGobiUSBNet *, u16, void *),
+    void *             pData );
+
+// Notification function for synchronous read
+static void UpSem(
+    sGobiUSBNet *    pDev,
+    u16                clientID,
+    void *             pData );
+
+// Start synchronous read
+//     Reading client's data store, not device
+static int ReadSync(
+    sGobiUSBNet *    pDev,
+    void **            ppOutBuffer,
+    u16                clientID,
+    u16                transactionID );
+
+// Write callback
+#if (LINUX_VERSION_CODE > KERNEL_VERSION( 2,6,18 ))
+static void WriteSyncCallback( struct urb * pWriteURB );
+#else
+static void WriteSyncCallback(struct urb *pWriteURB, struct pt_regs *regs);
+#endif
+
+// Start synchronous write
+static int WriteSync(
+    sGobiUSBNet *    pDev,
+    char *             pInWriteBuffer,
+    int                size,
+    u16                clientID );
+
+/*=========================================================================*/
+// Internal memory management functions
+/*=========================================================================*/
+
+// Create client and allocate memory
+static int GetClientID(
+    sGobiUSBNet *      pDev,
+    u8                   serviceType );
+
+// Release client and free memory
+static void ReleaseClientID(
+    sGobiUSBNet *      pDev,
+    u16                  clientID );
+
+// Find this client's memory
+static sClientMemList * FindClientMem(
+    sGobiUSBNet *      pDev,
+    u16                  clientID );
+
+// Add Data to this client's ReadMem list
+static bool AddToReadMemList(
+    sGobiUSBNet *      pDev,
+    u16                  clientID,
+    u16                  transactionID,
+    void *               pData,
+    u16                  dataSize );
+
+// Remove data from this client's ReadMem list if it matches
+// the specified transaction ID.
+static bool PopFromReadMemList(
+    sGobiUSBNet *      pDev,
+    u16                  clientID,
+    u16                  transactionID,
+    void **              ppData,
+    u16 *                pDataSize );
+
+// Add Notify entry to this client's notify List
+static bool AddToNotifyList(
+    sGobiUSBNet *      pDev,
+    u16                  clientID,
+    u16                  transactionID,
+    void                 (* pNotifyFunct)(sGobiUSBNet *, u16, void *),
+    void *               pData );
+
+// Remove first Notify entry from this client's notify list
+//    and Run function
+static bool NotifyAndPopNotifyList(
+    sGobiUSBNet *      pDev,
+    u16                  clientID,
+    u16                  transactionID );
+
+// Add URB to this client's URB list
+static bool AddToURBList(
+    sGobiUSBNet *      pDev,
+    u16                  clientID,
+    struct urb *         pURB );
+
+// Remove URB from this client's URB list
+static struct urb * PopFromURBList(
+    sGobiUSBNet *      pDev,
+    u16                  clientID );
+
+/*=========================================================================*/
+// Internal userspace wrappers
+/*=========================================================================*/
+
+// Userspace unlocked ioctl
+static long UserspaceunlockedIOCTL(
+    struct file *     pFilp,
+    unsigned int      cmd,
+    unsigned long     arg );
+
+/*=========================================================================*/
+// Userspace wrappers
+/*=========================================================================*/
+
+// Userspace open
+static int UserspaceOpen(
+    struct inode *   pInode,
+    struct file *    pFilp );
+
+#if (LINUX_VERSION_CODE < KERNEL_VERSION( 2,6,36 ))
+// Userspace ioctl
+static int UserspaceIOCTL(
+    struct inode *    pUnusedInode,
+    struct file *     pFilp,
+    unsigned int      cmd,
+    unsigned long     arg );
+#endif
+
+// Userspace close
+#define meig_no_for_each_process
+#ifdef meig_no_for_each_process
+static int UserspaceClose(
+    struct inode *   pInode,
+    struct file *    pFilp );
+#else
+#if (LINUX_VERSION_CODE > KERNEL_VERSION( 2,6,14 ))
+static int UserspaceClose(
+    struct file *       pFilp,
+    fl_owner_t          unusedFileTable );
+#else
+static int UserspaceClose( struct file *       pFilp );
+#endif
+#endif
+
+// Userspace read (synchronous)
+static ssize_t UserspaceRead(
+    struct file *        pFilp,
+    char __user *        pBuf,
+    size_t               size,
+    loff_t *             pUnusedFpos );
+
+// Userspace write (synchronous)
+static ssize_t UserspaceWrite(
+    struct file *        pFilp,
+    const char __user *  pBuf,
+    size_t               size,
+    loff_t *             pUnusedFpos );
+
+static unsigned int UserspacePoll(
+    struct file *                  pFilp,
+    struct poll_table_struct *     pPollTable );
+
+/*=========================================================================*/
+// Driver level client management
+/*=========================================================================*/
+
+// Check if QMI is ready for use
+static bool QMIReady(
+    sGobiUSBNet *    pDev,
+    u16                timeout );
+
+// QMI WDS callback function
+static void QMIWDSCallback(
+    sGobiUSBNet *    pDev,
+    u16                clientID,
+    void *             pData );
+
+// Fire off reqests and start async read for QMI WDS callback
+static int SetupQMIWDSCallback( sGobiUSBNet * pDev );
+
+// Register client, send req and parse MEID response, release client
+static int QMIDMSGetMEID( sGobiUSBNet * pDev );
+
+// Register client, send req and parse Data format response, release client
+static int QMIWDASetDataFormat( sGobiUSBNet * pDev, int qmap_mode, int *rx_urb_size );
+#endif
+
+// Print Hex data, for debug purposes
+void MeigPrintHex(
+    void *         pBuffer,
+    u16            bufSize );
+
+// Sets mDownReason and turns carrier off
+void MeigGobiSetDownReason(
+    sGobiUSBNet *    pDev,
+    u8                 reason );
+
+// Clear mDownReason and may turn carrier on
+void MeigGobiClearDownReason(
+    sGobiUSBNet *    pDev,
+    u8                 reason );
+
+// Tests mDownReason and returns whether reason is set
+bool MeigGobiTestDownReason(
+    sGobiUSBNet *    pDev,
+    u8                 reason );
+
+// Start continuous read "thread"
+int MeigStartRead( sGobiUSBNet * pDev );
+
+// Kill continuous read "thread"
+void MeigKillRead( sGobiUSBNet * pDev );
+
+/*=========================================================================*/
+// Initializer and destructor
+/*=========================================================================*/
+
+// QMI Device initialization function
+int MeigRegisterQMIDevice( sGobiUSBNet * pDev );
+
+// QMI Device cleanup function
+void MeigDeregisterQMIDevice( sGobiUSBNet * pDev );
+
+int MeigQMIWDASetDataFormat( sGobiUSBNet * pDev, int qmap_mode, int *rx_urb_size );
+
+#define PrintHex MeigPrintHex
+#define GobiSetDownReason MeigGobiSetDownReason
+#define GobiClearDownReason MeigGobiClearDownReason
+#define GobiTestDownReason MeigGobiTestDownReason
+#define StartRead MeigStartRead
+#define KillRead MeigKillRead
+#define RegisterQMIDevice MeigRegisterQMIDevice
+#define DeregisterQMIDevice MeigDeregisterQMIDevice

root/package/link4all/gobinet_srm815/src.old/Readme.txt

@@ -0,0 +1,15 @@
+使用方法
+1.编译gobinet驱动
+PC端按如下方法:
+make
+insmod GobiNet.ko
+嵌入式平台可修改makefile后编译
+2.编译拨号工具
+cd meig-cm/
+make 
+嵌入式平台同样要修改Makefile后编译
+3.拨号
+./meig-cm -s [APN名称]
+如移动卡拨号:
+./meig-cm -s cmnet
+

root/package/link4all/gobinet_srm815/src.old/Structs.h

@@ -0,0 +1,455 @@
+/*===========================================================================
+FILE:
+   Structs.h
+
+DESCRIPTION:
+   Declaration of structures used by the Qualcomm Linux USB Network driver
+
+FUNCTIONS:
+   none
+
+Copyright (c) 2011, Code Aurora Forum. All rights reserved.
+
+Redistribution and use in source and binary forms, with or without
+modification, are permitted provided that the following conditions are met:
+    * Redistributions of source code must retain the above copyright
+      notice, this list of conditions and the following disclaimer.
+    * Redistributions in binary form must reproduce the above copyright
+      notice, this list of conditions and the following disclaimer in the
+      documentation and/or other materials provided with the distribution.
+    * Neither the name of Code Aurora Forum nor
+      the names of its contributors may be used to endorse or promote
+      products derived from this software without specific prior written
+      permission.
+
+
+THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
+ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
+LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
+CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
+SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
+INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
+CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
+ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
+POSSIBILITY OF SUCH DAMAGE.
+===========================================================================*/
+
+//---------------------------------------------------------------------------
+// Pragmas
+//---------------------------------------------------------------------------
+#pragma once
+
+//---------------------------------------------------------------------------
+// Include Files
+//---------------------------------------------------------------------------
+#include <linux/etherdevice.h>
+#include <linux/ethtool.h>
+#include <linux/mii.h>
+#include <linux/usb.h>
+#include <linux/version.h>
+#include <linux/cdev.h>
+#include <linux/kthread.h>
+#include <linux/poll.h>
+#include <linux/completion.h>
+
+#define MEIG_WWAN_QMAP 8
+#ifdef MEIG_WWAN_QMAP
+#define MEIG_QMAP_MUX_ID 0x81
+#endif
+
+#if (LINUX_VERSION_CODE <= KERNEL_VERSION( 2,6,21 ))
+static inline void skb_reset_mac_header(struct sk_buff *skb)
+{
+    skb->mac.raw = skb->data;
+}
+#endif
+
+#if (LINUX_VERSION_CODE <= KERNEL_VERSION( 2,6,22 ))
+#define bool      u8
+#ifndef URB_FREE_BUFFER
+#define URB_FREE_BUFFER_BY_SELF //usb_free_urb will not free, should free by self
+#define URB_FREE_BUFFER		0x0100	/* Free transfer buffer with the URB */
+#endif
+
+/**
+ * usb_endpoint_type - get the endpoint's transfer type
+ * @epd: endpoint to be checked
+ *
+ * Returns one of USB_ENDPOINT_XFER_{CONTROL, ISOC, BULK, INT} according
+ * to @epd's transfer type.
+ */
+static inline int usb_endpoint_type(const struct usb_endpoint_descriptor *epd)
+{
+    return epd->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK;
+}
+#endif
+
+#if (LINUX_VERSION_CODE <= KERNEL_VERSION( 2,6,18 ))
+/**
+ * usb_endpoint_dir_in - check if the endpoint has IN direction
+ * @epd: endpoint to be checked
+ *
+ * Returns true if the endpoint is of type IN, otherwise it returns false.
+ */
+static inline int usb_endpoint_dir_in(const struct usb_endpoint_descriptor *epd)
+{
+    return ((epd->bEndpointAddress & USB_ENDPOINT_DIR_MASK) == USB_DIR_IN);
+}
+
+/**
+ * usb_endpoint_dir_out - check if the endpoint has OUT direction
+ * @epd: endpoint to be checked
+ *
+ * Returns true if the endpoint is of type OUT, otherwise it returns false.
+ */
+static inline int usb_endpoint_dir_out(
+    const struct usb_endpoint_descriptor *epd)
+{
+    return ((epd->bEndpointAddress & USB_ENDPOINT_DIR_MASK) == USB_DIR_OUT);
+}
+
+/**
+ * usb_endpoint_xfer_int - check if the endpoint has interrupt transfer type
+ * @epd: endpoint to be checked
+ *
+ * Returns true if the endpoint is of type interrupt, otherwise it returns
+ * false.
+ */
+static inline int usb_endpoint_xfer_int(
+    const struct usb_endpoint_descriptor *epd)
+{
+    return ((epd->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK) ==
+            USB_ENDPOINT_XFER_INT);
+}
+
+static inline int usb_autopm_set_interface(struct usb_interface *intf)
+{
+    return 0;
+}
+
+static inline int usb_autopm_get_interface(struct usb_interface *intf)
+{
+    return 0;
+}
+
+static inline int usb_autopm_get_interface_async(struct usb_interface *intf)
+{
+    return 0;
+}
+
+static inline void usb_autopm_put_interface(struct usb_interface *intf)
+{ }
+static inline void usb_autopm_put_interface_async(struct usb_interface *intf)
+{ }
+static inline void usb_autopm_enable(struct usb_interface *intf)
+{ }
+static inline void usb_autopm_disable(struct usb_interface *intf)
+{ }
+static inline void usb_mark_last_busy(struct usb_device *udev)
+{ }
+#endif
+
+#if (LINUX_VERSION_CODE <= KERNEL_VERSION( 2,6,24 ))
+#include "usbnet.h"
+#else
+#include <linux/usb/usbnet.h>
+#endif
+
+#if (LINUX_VERSION_CODE > KERNEL_VERSION( 2,6,25 ))
+#include <linux/fdtable.h>
+#else
+#include <linux/file.h>
+#endif
+
+// Used in recursion, defined later below
+struct sGobiUSBNet;
+
+/*=========================================================================*/
+// Struct sReadMemList
+//
+//    Structure that defines an entry in a Read Memory linked list
+/*=========================================================================*/
+typedef struct sReadMemList {
+    /* Data buffer */
+    void *                     mpData;
+
+    /* Transaction ID */
+    u16                        mTransactionID;
+
+    /* Size of data buffer */
+    u16                        mDataSize;
+
+    /* Next entry in linked list */
+    struct sReadMemList *      mpNext;
+
+} sReadMemList;
+
+/*=========================================================================*/
+// Struct sNotifyList
+//
+//    Structure that defines an entry in a Notification linked list
+/*=========================================================================*/
+typedef struct sNotifyList {
+    /* Function to be run when data becomes available */
+    void                  (* mpNotifyFunct)(struct sGobiUSBNet *, u16, void *);
+
+    /* Transaction ID */
+    u16                   mTransactionID;
+
+    /* Data to provide as parameter to mpNotifyFunct */
+    void *                mpData;
+
+    /* Next entry in linked list */
+    struct sNotifyList *  mpNext;
+
+} sNotifyList;
+
+/*=========================================================================*/
+// Struct sURBList
+//
+//    Structure that defines an entry in a URB linked list
+/*=========================================================================*/
+typedef struct sURBList {
+    /* The current URB */
+    struct urb *       mpURB;
+
+    /* Next entry in linked list */
+    struct sURBList *  mpNext;
+
+} sURBList;
+
+/*=========================================================================*/
+// Struct sClientMemList
+//
+//    Structure that defines an entry in a Client Memory linked list
+//      Stores data specific to a Service Type and Client ID
+/*=========================================================================*/
+typedef struct sClientMemList {
+    /* Client ID for this Client */
+    u16                          mClientID;
+
+    /* Linked list of Read entries */
+    /*    Stores data read from device before sending to client */
+    sReadMemList *               mpList;
+
+    /* Linked list of Notification entries */
+    /*    Stores notification functions to be run as data becomes
+          available or the device is removed */
+    sNotifyList *                mpReadNotifyList;
+
+    /* Linked list of URB entries */
+    /*    Stores pointers to outstanding URBs which need canceled
+          when the client is deregistered or the device is removed */
+    sURBList *                   mpURBList;
+
+    /* Next entry in linked list */
+    struct sClientMemList *      mpNext;
+
+    /* Wait queue object for poll() */
+    wait_queue_head_t    mWaitQueue;
+
+} sClientMemList;
+
+/*=========================================================================*/
+// Struct sURBSetupPacket
+//
+//    Structure that defines a USB Setup packet for Control URBs
+//    Taken from USB CDC specifications
+/*=========================================================================*/
+typedef struct sURBSetupPacket {
+    /* Request type */
+    u8    mRequestType;
+
+    /* Request code */
+    u8    mRequestCode;
+
+    /* Value */
+    u16   mValue;
+
+    /* Index */
+    u16   mIndex;
+
+    /* Length of Control URB */
+    u16   mLength;
+
+} sURBSetupPacket;
+
+// Common value for sURBSetupPacket.mLength
+#define DEFAULT_READ_URB_LENGTH 0x1000
+
+#ifdef CONFIG_PM
+#if (LINUX_VERSION_CODE < KERNEL_VERSION( 2,6,29 ))
+/*=========================================================================*/
+// Struct sAutoPM
+//
+//    Structure used to manage AutoPM thread which determines whether the
+//    device is in use or may enter autosuspend.  Also submits net
+//    transmissions asynchronously.
+/*=========================================================================*/
+typedef struct sAutoPM {
+    /* Thread for atomic autopm function */
+    struct task_struct *       mpThread;
+
+    /* Signal for completion when it's time for the thread to work */
+    struct completion          mThreadDoWork;
+
+    /* Time to exit? */
+    bool                       mbExit;
+
+    /* List of URB's queued to be sent to the device */
+    sURBList *                 mpURBList;
+
+    /* URB list lock (for adding and removing elements) */
+    spinlock_t                 mURBListLock;
+
+    /* Length of the URB list */
+    atomic_t                   mURBListLen;
+
+    /* Active URB */
+    struct urb *               mpActiveURB;
+
+    /* Active URB lock (for adding and removing elements) */
+    spinlock_t                 mActiveURBLock;
+
+    /* Duplicate pointer to USB device interface */
+    struct usb_interface *     mpIntf;
+
+} sAutoPM;
+#endif
+#endif /* CONFIG_PM */
+
+/*=========================================================================*/
+// Struct sQMIDev
+//
+//    Structure that defines the data for the QMI device
+/*=========================================================================*/
+typedef struct sQMIDev {
+    /* Device number */
+    dev_t                      mDevNum;
+
+    /* Device class */
+    struct class *             mpDevClass;
+
+    /* cdev struct */
+    struct cdev                mCdev;
+
+    /* is mCdev initialized? */
+    bool                       mbCdevIsInitialized;
+
+    /* Pointer to read URB */
+    struct urb *               mpReadURB;
+
+//#define READ_QMI_URB_ERROR
+#ifdef READ_QMI_URB_ERROR
+    struct timer_list mReadUrbTimer;
+#endif
+
+    /* Read setup packet */
+    sURBSetupPacket *          mpReadSetupPacket;
+
+    /* Read buffer attached to current read URB */
+    void *                     mpReadBuffer;
+
+    /* Inturrupt URB */
+    /*    Used to asynchronously notify when read data is available */
+    struct urb *               mpIntURB;
+
+    /* Buffer used by Inturrupt URB */
+    void *                     mpIntBuffer;
+
+    /* Pointer to memory linked list for all clients */
+    sClientMemList *           mpClientMemList;
+
+    /* Spinlock for client Memory entries */
+    spinlock_t                 mClientMemLock;
+
+    /* Transaction ID associated with QMICTL "client" */
+    atomic_t                   mQMICTLTransactionID;
+
+} sQMIDev;
+
+/*=========================================================================*/
+// Struct sGobiUSBNet
+//
+//    Structure that defines the data associated with the Qualcomm USB device
+/*=========================================================================*/
+typedef struct sGobiUSBNet {
+    atomic_t refcount;
+
+    /* Net device structure */
+    struct usbnet *        mpNetDev;
+#ifdef MEIG_WWAN_QMAP
+    int m_qmap_mode;
+    struct net_device	*mpQmapNetDev[MEIG_WWAN_QMAP];
+#ifdef CONFIG_BRIDGE
+    int m_qmap_bridge_mode[MEIG_WWAN_QMAP];
+#endif
+#endif
+
+#if 1 //def DATA_MODE_RP
+    bool                   mbMdm9x07;
+    bool                   mbMdm9x06;	//for BG96
+    /* QMI "device" work in IP Mode or ETH Mode */
+    bool                   mbRawIPMode;
+#ifdef CONFIG_BRIDGE
+    int m_bridge_mode;
+    uint m_bridge_ipv4;
+    unsigned char     mHostMAC[6];
+#endif
+    int m_qcrmcall_mode;
+#endif
+
+    struct completion mQMIReadyCompletion;
+    bool                   mbQMIReady;
+
+    /* Usb device interface */
+    struct usb_interface * mpIntf;
+
+    /* Pointers to usbnet_open and usbnet_stop functions */
+    int                  (* mpUSBNetOpen)(struct net_device *);
+    int                  (* mpUSBNetStop)(struct net_device *);
+
+    /* Reason(s) why interface is down */
+    /* Used by Gobi*DownReason */
+    unsigned long          mDownReason;
+#define NO_NDIS_CONNECTION    0
+#define CDC_CONNECTION_SPEED  1
+#define DRIVER_SUSPENDED      2
+#define NET_IFACE_STOPPED     3
+
+    /* QMI "device" status */
+    bool                   mbQMIValid;
+
+    bool                   mbDeregisterQMIDevice;
+
+    /* QMI "device" memory */
+    sQMIDev                mQMIDev;
+
+    /* Device MEID */
+    char                   mMEID[14];
+
+#ifdef CONFIG_PM
+#if (LINUX_VERSION_CODE < KERNEL_VERSION( 2,6,29 ))
+    /* AutoPM thread */
+    sAutoPM                mAutoPM;
+#endif
+#endif /* CONFIG_PM */
+} sGobiUSBNet;
+
+/*=========================================================================*/
+// Struct sQMIFilpStorage
+//
+//    Structure that defines the storage each file handle contains
+//       Relates the file handle to a client
+/*=========================================================================*/
+typedef struct sQMIFilpStorage {
+    /* Client ID */
+    u16                  mClientID;
+
+    /* Device pointer */
+    sGobiUSBNet *        mpDev;
+
+} sQMIFilpStorage;
+

root/package/link4all/gobinet_srm815/src/QMI.h

@@ -0,0 +1,337 @@
+/*===========================================================================
+FILE:
+   QMI.h
+
+DESCRIPTION:
+   Qualcomm QMI driver header
+
+FUNCTIONS:
+   Generic QMUX functions
+      ParseQMUX
+      FillQMUX
+
+   Generic QMI functions
+      GetTLV
+      ValidQMIMessage
+      GetQMIMessageID
+
+   Get sizes of buffers needed by QMI requests
+      QMUXHeaderSize
+      QMICTLGetClientIDReqSize
+      QMICTLReleaseClientIDReqSize
+      QMICTLReadyReqSize
+      QMIWDSSetEventReportReqSize
+      QMIWDSGetPKGSRVCStatusReqSize
+      QMIDMSGetMEIDReqSize
+      QMICTLSyncReqSize
+
+   Fill Buffers with QMI requests
+      QMICTLGetClientIDReq
+      QMICTLReleaseClientIDReq
+      QMICTLReadyReq
+      QMIWDSSetEventReportReq
+      QMIWDSGetPKGSRVCStatusReq
+      QMIDMSGetMEIDReq
+      QMICTLSetDataFormatReq
+      QMICTLSyncReq
+
+   Parse data from QMI responses
+      QMICTLGetClientIDResp
+      QMICTLReleaseClientIDResp
+      QMIWDSEventResp
+      QMIDMSGetMEIDResp
+
+Copyright (c) 2011, Code Aurora Forum. All rights reserved.
+
+Redistribution and use in source and binary forms, with or without
+modification, are permitted provided that the following conditions are met:
+    * Redistributions of source code must retain the above copyright
+      notice, this list of conditions and the following disclaimer.
+    * Redistributions in binary form must reproduce the above copyright
+      notice, this list of conditions and the following disclaimer in the
+      documentation and/or other materials provided with the distribution.
+    * Neither the name of Code Aurora Forum nor
+      the names of its contributors may be used to endorse or promote
+      products derived from this software without specific prior written
+      permission.
+
+
+THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
+ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
+LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
+CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
+SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
+INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
+CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
+ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
+POSSIBILITY OF SUCH DAMAGE.
+===========================================================================*/
+
+#pragma once
+
+/*=========================================================================*/
+// Definitions
+/*=========================================================================*/
+
+extern int meig_debug;
+// DBG macro
+#define DBG( format, arg... ) do { \
+   if (meig_debug == 1)\
+   { \
+      printk( KERN_INFO "GobiNet::%s " format, __FUNCTION__, ## arg ); \
+   } }while(0)
+
+#if 0
+#define VDBG( format, arg... ) do { \
+   if (debug == 1)\
+   { \
+      printk( KERN_INFO "GobiNet::%s " format, __FUNCTION__, ## arg ); \
+   } } while(0)
+#else
+#define VDBG( format, arg... ) do { } while(0)
+#endif
+
+#define INFO( format, arg... ) do { \
+      printk( KERN_INFO "GobiNet::%s " format, __FUNCTION__, ## arg ); \
+   }while(0)
+
+// QMI Service Types
+#define QMICTL 0
+#define QMIWDS 1
+#define QMIDMS 2
+#define QMINAS 3
+#define QMIUIM 11
+#define QMIWDA 0x1A
+
+#define u8        unsigned char
+#define u16       unsigned short
+#define u32       unsigned int
+#define u64       unsigned long long
+
+#define bool      u8
+#define true      1
+#define false     0
+
+#define ENOMEM    12
+#define EFAULT    14
+#define EINVAL    22
+#ifndef ENOMSG
+#define ENOMSG    42
+#endif
+#define ENODATA   61
+
+#define TLV_TYPE_LINK_PROTO 0x10
+
+/*=========================================================================*/
+// Struct sQMUX
+//
+//    Structure that defines a QMUX header
+/*=========================================================================*/
+typedef struct sQMUX {
+    /* T\F, always 1 */
+    u8         mTF;
+
+    /* Size of message */
+    u16        mLength;
+
+    /* Control flag */
+    u8         mCtrlFlag;
+
+    /* Service Type */
+    u8         mQMIService;
+
+    /* Client ID */
+    u8         mQMIClientID;
+
+} __attribute__((__packed__)) sQMUX;
+
+#if 0
+/*=========================================================================*/
+// Generic QMUX functions
+/*=========================================================================*/
+
+// Remove QMUX headers from a buffer
+int ParseQMUX(
+    u16 *    pClientID,
+    void *   pBuffer,
+    u16      buffSize );
+
+// Fill buffer with QMUX headers
+int FillQMUX(
+    u16      clientID,
+    void *   pBuffer,
+    u16      buffSize );
+
+/*=========================================================================*/
+// Generic QMI functions
+/*=========================================================================*/
+
+// Get data buffer of a specified TLV from a QMI message
+int GetTLV(
+    void *   pQMIMessage,
+    u16      messageLen,
+    u8       type,
+    void *   pOutDataBuf,
+    u16      bufferLen );
+
+// Check mandatory TLV in a QMI message
+int ValidQMIMessage(
+    void *   pQMIMessage,
+    u16      messageLen );
+
+// Get the message ID of a QMI message
+int GetQMIMessageID(
+    void *   pQMIMessage,
+    u16      messageLen );
+
+/*=========================================================================*/
+// Get sizes of buffers needed by QMI requests
+/*=========================================================================*/
+
+// Get size of buffer needed for QMUX
+u16 QMUXHeaderSize( void );
+
+// Get size of buffer needed for QMUX + QMICTLGetClientIDReq
+u16 QMICTLGetClientIDReqSize( void );
+
+// Get size of buffer needed for QMUX + QMICTLReleaseClientIDReq
+u16 QMICTLReleaseClientIDReqSize( void );
+
+// Get size of buffer needed for QMUX + QMICTLReadyReq
+u16 QMICTLReadyReqSize( void );
+
+// Get size of buffer needed for QMUX + QMIWDSSetEventReportReq
+u16 QMIWDSSetEventReportReqSize( void );
+
+// Get size of buffer needed for QMUX + QMIWDSGetPKGSRVCStatusReq
+u16 QMIWDSGetPKGSRVCStatusReqSize( void );
+
+u16 QMIWDSSetQMUXBindMuxDataPortSize( void );
+
+// Get size of buffer needed for QMUX + QMIDMSGetMEIDReq
+u16 QMIDMSGetMEIDReqSize( void );
+
+// Get size of buffer needed for QMUX + QMIWDASetDataFormatReq
+u16 QMIWDASetDataFormatReqSize( int qmap_mode );
+
+// Get size of buffer needed for QMUX + QMICTLSyncReq
+u16 QMICTLSyncReqSize( void );
+
+/*=========================================================================*/
+// Fill Buffers with QMI requests
+/*=========================================================================*/
+
+// Fill buffer with QMI CTL Get Client ID Request
+int QMICTLGetClientIDReq(
+    void *   pBuffer,
+    u16      buffSize,
+    u8       transactionID,
+    u8       serviceType );
+
+// Fill buffer with QMI CTL Release Client ID Request
+int QMICTLReleaseClientIDReq(
+    void *   pBuffer,
+    u16      buffSize,
+    u8       transactionID,
+    u16      clientID );
+
+// Fill buffer with QMI CTL Get Version Info Request
+int QMICTLReadyReq(
+    void *   pBuffer,
+    u16      buffSize,
+    u8       transactionID );
+
+// Fill buffer with QMI WDS Set Event Report Request
+int QMIWDSSetEventReportReq(
+    void *   pBuffer,
+    u16      buffSize,
+    u16      transactionID );
+
+// Fill buffer with QMI WDS Get PKG SRVC Status Request
+int QMIWDSGetPKGSRVCStatusReq(
+    void *   pBuffer,
+    u16      buffSize,
+    u16      transactionID );
+
+u16 QMIWDSSetQMUXBindMuxDataPortReq(
+    void *   pBuffer,
+    u16      buffSize,
+    u8 MuxId,
+    sGobiUSBNet * pDev, //add for net interface bond by zhaopf
+    u16      transactionID );
+
+// Fill buffer with QMI DMS Get Serial Numbers Request
+int QMIDMSGetMEIDReq(
+    void *   pBuffer,
+    u16      buffSize,
+    u16      transactionID );
+
+// Fill buffer with QMI WDA Set Data Format Request
+int QMIWDASetDataFormatReq(
+    void *   pBuffer,
+    u16      buffSize,
+    bool     bRawIPMode, int qmap_mode, u32 rx_size,
+    u16      transactionID );
+
+#if 0
+int QMIWDASetDataQmapReq(
+    void *   pBuffer,
+    u16      buffSize,
+    u16      transactionID );
+#endif
+
+int QMICTLSyncReq(
+    void *   pBuffer,
+    u16      buffSize,
+    u16      transactionID );
+
+/*=========================================================================*/
+// Parse data from QMI responses
+/*=========================================================================*/
+
+// Parse the QMI CTL Get Client ID Resp
+int QMICTLGetClientIDResp(
+    void * pBuffer,
+    u16    buffSize,
+    u16 *  pClientID );
+
+// Verify the QMI CTL Release Client ID Resp is valid
+int QMICTLReleaseClientIDResp(
+    void *   pBuffer,
+    u16      buffSize );
+
+// Parse the QMI WDS Set Event Report Resp/Indication or
+//    QMI WDS Get PKG SRVC Status Resp/Indication
+int QMIWDSEventResp(
+    void *   pBuffer,
+    u16      buffSize,
+    u32 *    pTXOk,
+    u32 *    pRXOk,
+    u32 *    pTXErr,
+    u32 *    pRXErr,
+    u32 *    pTXOfl,
+    u32 *    pRXOfl,
+    u64 *    pTXBytesOk,
+    u64 *    pRXBytesOk,
+    bool *   pbLinkState,
+    bool *   pbReconfigure );
+
+// Parse the QMI DMS Get Serial Numbers Resp
+int QMIDMSGetMEIDResp(
+    void *   pBuffer,
+    u16      buffSize,
+    char *   pMEID,
+    int      meidSize );
+
+// Parse the QMI DMS Get Serial Numbers Resp
+int QMIWDASetDataFormatResp(
+    void *   pBuffer,
+    u16      buffSize, bool bRawIPMode, int *qmap_enabled, int *rx_size, int *tx_size);
+
+// Pasre the QMI CTL Sync Response
+int QMICTLSyncResp(
+    void *pBuffer,
+    u16  buffSize );
+#endif

root/package/link4all/gobinet_srm815/src/QMIDevice.h

@@ -0,0 +1,368 @@
+/*===========================================================================
+FILE:
+   QMIDevice.h
+
+DESCRIPTION:
+   Functions related to the QMI interface device
+
+FUNCTIONS:
+   Generic functions
+      IsDeviceValid
+      PrintHex
+      GobiSetDownReason
+      GobiClearDownReason
+      GobiTestDownReason
+
+   Driver level asynchronous read functions
+      ResubmitIntURB
+      ReadCallback
+      IntCallback
+      StartRead
+      KillRead
+
+   Internal read/write functions
+      ReadAsync
+      UpSem
+      ReadSync
+      WriteSyncCallback
+      WriteSync
+
+   Internal memory management functions
+      GetClientID
+      ReleaseClientID
+      FindClientMem
+      AddToReadMemList
+      PopFromReadMemList
+      AddToNotifyList
+      NotifyAndPopNotifyList
+      AddToURBList
+      PopFromURBList
+
+   Internal userspace wrapper functions
+      UserspaceunlockedIOCTL
+
+   Userspace wrappers
+      UserspaceOpen
+      UserspaceIOCTL
+      UserspaceClose
+      UserspaceRead
+      UserspaceWrite
+      UserspacePoll
+
+   Initializer and destructor
+      RegisterQMIDevice
+      DeregisterQMIDevice
+
+   Driver level client management
+      QMIReady
+      QMIWDSCallback
+      SetupQMIWDSCallback
+      QMIDMSGetMEID
+
+Copyright (c) 2011, Code Aurora Forum. All rights reserved.
+
+Redistribution and use in source and binary forms, with or without
+modification, are permitted provided that the following conditions are met:
+    * Redistributions of source code must retain the above copyright
+      notice, this list of conditions and the following disclaimer.
+    * Redistributions in binary form must reproduce the above copyright
+      notice, this list of conditions and the following disclaimer in the
+      documentation and/or other materials provided with the distribution.
+    * Neither the name of Code Aurora Forum nor
+      the names of its contributors may be used to endorse or promote
+      products derived from this software without specific prior written
+      permission.
+
+
+THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
+ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
+LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
+CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
+SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
+INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
+CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
+ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
+POSSIBILITY OF SUCH DAMAGE.
+===========================================================================*/
+
+//---------------------------------------------------------------------------
+// Pragmas
+//---------------------------------------------------------------------------
+#pragma once
+
+//---------------------------------------------------------------------------
+// Include Files
+//---------------------------------------------------------------------------
+#include "Structs.h"
+#include "QMI.h"
+
+/*=========================================================================*/
+// Generic functions
+/*=========================================================================*/
+
+#ifdef __MEIG_INTER__
+
+// Basic test to see if device memory is valid
+static bool IsDeviceValid( sGobiUSBNet * pDev );
+
+/*=========================================================================*/
+// Driver level asynchronous read functions
+/*=========================================================================*/
+
+// Resubmit interrupt URB, re-using same values
+static int ResubmitIntURB( struct urb * pIntURB );
+
+// Read callback
+//    Put the data in storage and notify anyone waiting for data
+#if (LINUX_VERSION_CODE > KERNEL_VERSION( 2,6,18 ))
+static void ReadCallback( struct urb * pReadURB );
+#else
+static void ReadCallback(struct urb *pReadURB, struct pt_regs *regs);
+#endif
+
+// Inturrupt callback
+//    Data is available, start a read URB
+#if (LINUX_VERSION_CODE > KERNEL_VERSION( 2,6,18 ))
+static void IntCallback( struct urb * pIntURB );
+#else
+static void IntCallback(struct urb *pIntURB, struct pt_regs *regs);
+#endif
+
+/*=========================================================================*/
+// Internal read/write functions
+/*=========================================================================*/
+
+// Start asynchronous read
+//     Reading client's data store, not device
+static int ReadAsync(
+    sGobiUSBNet *    pDev,
+    u16                clientID,
+    u16                transactionID,
+    void               (*pCallback)(sGobiUSBNet *, u16, void *),
+    void *             pData );
+
+// Notification function for synchronous read
+static void UpSem(
+    sGobiUSBNet *    pDev,
+    u16                clientID,
+    void *             pData );
+
+// Start synchronous read
+//     Reading client's data store, not device
+static int ReadSync(
+    sGobiUSBNet *    pDev,
+    void **            ppOutBuffer,
+    u16                clientID,
+    u16                transactionID );
+
+// Write callback
+#if (LINUX_VERSION_CODE > KERNEL_VERSION( 2,6,18 ))
+static void WriteSyncCallback( struct urb * pWriteURB );
+#else
+static void WriteSyncCallback(struct urb *pWriteURB, struct pt_regs *regs);
+#endif
+
+// Start synchronous write
+static int WriteSync(
+    sGobiUSBNet *    pDev,
+    char *             pInWriteBuffer,
+    int                size,
+    u16                clientID );
+
+/*=========================================================================*/
+// Internal memory management functions
+/*=========================================================================*/
+
+// Create client and allocate memory
+static int GetClientID(
+    sGobiUSBNet *      pDev,
+    u8                   serviceType );
+
+// Release client and free memory
+static void ReleaseClientID(
+    sGobiUSBNet *      pDev,
+    u16                  clientID );
+
+// Find this client's memory
+static sClientMemList * FindClientMem(
+    sGobiUSBNet *      pDev,
+    u16                  clientID );
+
+// Add Data to this client's ReadMem list
+static bool AddToReadMemList(
+    sGobiUSBNet *      pDev,
+    u16                  clientID,
+    u16                  transactionID,
+    void *               pData,
+    u16                  dataSize );
+
+// Remove data from this client's ReadMem list if it matches
+// the specified transaction ID.
+static bool PopFromReadMemList(
+    sGobiUSBNet *      pDev,
+    u16                  clientID,
+    u16                  transactionID,
+    void **              ppData,
+    u16 *                pDataSize );
+
+// Add Notify entry to this client's notify List
+static bool AddToNotifyList(
+    sGobiUSBNet *      pDev,
+    u16                  clientID,
+    u16                  transactionID,
+    void                 (* pNotifyFunct)(sGobiUSBNet *, u16, void *),
+    void *               pData );
+
+// Remove first Notify entry from this client's notify list
+//    and Run function
+static bool NotifyAndPopNotifyList(
+    sGobiUSBNet *      pDev,
+    u16                  clientID,
+    u16                  transactionID );
+
+// Add URB to this client's URB list
+static bool AddToURBList(
+    sGobiUSBNet *      pDev,
+    u16                  clientID,
+    struct urb *         pURB );
+
+// Remove URB from this client's URB list
+static struct urb * PopFromURBList(
+    sGobiUSBNet *      pDev,
+    u16                  clientID );
+
+/*=========================================================================*/
+// Internal userspace wrappers
+/*=========================================================================*/
+
+// Userspace unlocked ioctl
+static long UserspaceunlockedIOCTL(
+    struct file *     pFilp,
+    unsigned int      cmd,
+    unsigned long     arg );
+
+/*=========================================================================*/
+// Userspace wrappers
+/*=========================================================================*/
+
+// Userspace open
+static int UserspaceOpen(
+    struct inode *   pInode,
+    struct file *    pFilp );
+
+#if (LINUX_VERSION_CODE < KERNEL_VERSION( 2,6,36 ))
+// Userspace ioctl
+static int UserspaceIOCTL(
+    struct inode *    pUnusedInode,
+    struct file *     pFilp,
+    unsigned int      cmd,
+    unsigned long     arg );
+#endif
+
+// Userspace close
+#define meig_no_for_each_process
+#ifdef meig_no_for_each_process
+static int UserspaceClose(
+    struct inode *   pInode,
+    struct file *    pFilp );
+#else
+#if (LINUX_VERSION_CODE > KERNEL_VERSION( 2,6,14 ))
+static int UserspaceClose(
+    struct file *       pFilp,
+    fl_owner_t          unusedFileTable );
+#else
+static int UserspaceClose( struct file *       pFilp );
+#endif
+#endif
+
+// Userspace read (synchronous)
+static ssize_t UserspaceRead(
+    struct file *        pFilp,
+    char __user *        pBuf,
+    size_t               size,
+    loff_t *             pUnusedFpos );
+
+// Userspace write (synchronous)
+static ssize_t UserspaceWrite(
+    struct file *        pFilp,
+    const char __user *  pBuf,
+    size_t               size,
+    loff_t *             pUnusedFpos );
+
+static unsigned int UserspacePoll(
+    struct file *                  pFilp,
+    struct poll_table_struct *     pPollTable );
+
+/*=========================================================================*/
+// Driver level client management
+/*=========================================================================*/
+
+// Check if QMI is ready for use
+static bool QMIReady(
+    sGobiUSBNet *    pDev,
+    u16                timeout );
+
+// QMI WDS callback function
+static void QMIWDSCallback(
+    sGobiUSBNet *    pDev,
+    u16                clientID,
+    void *             pData );
+
+// Fire off reqests and start async read for QMI WDS callback
+static int SetupQMIWDSCallback( sGobiUSBNet * pDev );
+
+// Register client, send req and parse MEID response, release client
+static int QMIDMSGetMEID( sGobiUSBNet * pDev );
+
+// Register client, send req and parse Data format response, release client
+static int QMIWDASetDataFormat( sGobiUSBNet * pDev, int qmap_mode, int *rx_urb_size );
+#endif
+
+// Print Hex data, for debug purposes
+void MeigPrintHex(
+    void *         pBuffer,
+    u16            bufSize );
+
+// Sets mDownReason and turns carrier off
+void MeigGobiSetDownReason(
+    sGobiUSBNet *    pDev,
+    u8                 reason );
+
+// Clear mDownReason and may turn carrier on
+void MeigGobiClearDownReason(
+    sGobiUSBNet *    pDev,
+    u8                 reason );
+
+// Tests mDownReason and returns whether reason is set
+bool MeigGobiTestDownReason(
+    sGobiUSBNet *    pDev,
+    u8                 reason );
+
+// Start continuous read "thread"
+int MeigStartRead( sGobiUSBNet * pDev );
+
+// Kill continuous read "thread"
+void MeigKillRead( sGobiUSBNet * pDev );
+
+/*=========================================================================*/
+// Initializer and destructor
+/*=========================================================================*/
+
+// QMI Device initialization function
+int MeigRegisterQMIDevice( sGobiUSBNet * pDev );
+
+// QMI Device cleanup function
+void MeigDeregisterQMIDevice( sGobiUSBNet * pDev );
+
+int MeigQMIWDASetDataFormat( sGobiUSBNet * pDev, int qmap_mode, int *rx_urb_size );
+
+#define PrintHex MeigPrintHex
+#define GobiSetDownReason MeigGobiSetDownReason
+#define GobiClearDownReason MeigGobiClearDownReason
+#define GobiTestDownReason MeigGobiTestDownReason
+#define StartRead MeigStartRead
+#define KillRead MeigKillRead
+#define RegisterQMIDevice MeigRegisterQMIDevice
+#define DeregisterQMIDevice MeigDeregisterQMIDevice

root/package/link4all/gobinet_srm815/src/Readme.txt

@@ -0,0 +1,15 @@
+使用方法
+1.编译gobinet驱动
+PC端按如下方法:
+make
+insmod GobiNet.ko
+嵌入式平台可修改makefile后编译
+2.编译拨号工具
+cd meig-cm/
+make 
+嵌入式平台同样要修改Makefile后编译
+3.拨号
+./meig-cm -s [APN名称]
+如移动卡拨号:
+./meig-cm -s cmnet
+

root/package/link4all/gobinet_srm815/src/Structs.h

@@ -0,0 +1,455 @@
+/*===========================================================================
+FILE:
+   Structs.h
+
+DESCRIPTION:
+   Declaration of structures used by the Qualcomm Linux USB Network driver
+
+FUNCTIONS:
+   none
+
+Copyright (c) 2011, Code Aurora Forum. All rights reserved.
+
+Redistribution and use in source and binary forms, with or without
+modification, are permitted provided that the following conditions are met:
+    * Redistributions of source code must retain the above copyright
+      notice, this list of conditions and the following disclaimer.
+    * Redistributions in binary form must reproduce the above copyright
+      notice, this list of conditions and the following disclaimer in the
+      documentation and/or other materials provided with the distribution.
+    * Neither the name of Code Aurora Forum nor
+      the names of its contributors may be used to endorse or promote
+      products derived from this software without specific prior written
+      permission.
+
+
+THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
+ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
+LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
+CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
+SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
+INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
+CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
+ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
+POSSIBILITY OF SUCH DAMAGE.
+===========================================================================*/
+
+//---------------------------------------------------------------------------
+// Pragmas
+//---------------------------------------------------------------------------
+#pragma once
+
+//---------------------------------------------------------------------------
+// Include Files
+//---------------------------------------------------------------------------
+#include <linux/etherdevice.h>
+#include <linux/ethtool.h>
+#include <linux/mii.h>
+#include <linux/usb.h>
+#include <linux/version.h>
+#include <linux/cdev.h>
+#include <linux/kthread.h>
+#include <linux/poll.h>
+#include <linux/completion.h>
+
+#define MEIG_WWAN_QMAP 8
+#ifdef MEIG_WWAN_QMAP
+#define MEIG_QMAP_MUX_ID 0x81
+#endif
+
+#if (LINUX_VERSION_CODE <= KERNEL_VERSION( 2,6,21 ))
+static inline void skb_reset_mac_header(struct sk_buff *skb)
+{
+    skb->mac.raw = skb->data;
+}
+#endif
+
+#if (LINUX_VERSION_CODE <= KERNEL_VERSION( 2,6,22 ))
+#define bool      u8
+#ifndef URB_FREE_BUFFER
+#define URB_FREE_BUFFER_BY_SELF //usb_free_urb will not free, should free by self
+#define URB_FREE_BUFFER		0x0100	/* Free transfer buffer with the URB */
+#endif
+
+/**
+ * usb_endpoint_type - get the endpoint's transfer type
+ * @epd: endpoint to be checked
+ *
+ * Returns one of USB_ENDPOINT_XFER_{CONTROL, ISOC, BULK, INT} according
+ * to @epd's transfer type.
+ */
+static inline int usb_endpoint_type(const struct usb_endpoint_descriptor *epd)
+{
+    return epd->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK;
+}
+#endif
+
+#if (LINUX_VERSION_CODE <= KERNEL_VERSION( 2,6,18 ))
+/**
+ * usb_endpoint_dir_in - check if the endpoint has IN direction
+ * @epd: endpoint to be checked
+ *
+ * Returns true if the endpoint is of type IN, otherwise it returns false.
+ */
+static inline int usb_endpoint_dir_in(const struct usb_endpoint_descriptor *epd)
+{
+    return ((epd->bEndpointAddress & USB_ENDPOINT_DIR_MASK) == USB_DIR_IN);
+}
+
+/**
+ * usb_endpoint_dir_out - check if the endpoint has OUT direction
+ * @epd: endpoint to be checked
+ *
+ * Returns true if the endpoint is of type OUT, otherwise it returns false.
+ */
+static inline int usb_endpoint_dir_out(
+    const struct usb_endpoint_descriptor *epd)
+{
+    return ((epd->bEndpointAddress & USB_ENDPOINT_DIR_MASK) == USB_DIR_OUT);
+}
+
+/**
+ * usb_endpoint_xfer_int - check if the endpoint has interrupt transfer type
+ * @epd: endpoint to be checked
+ *
+ * Returns true if the endpoint is of type interrupt, otherwise it returns
+ * false.
+ */
+static inline int usb_endpoint_xfer_int(
+    const struct usb_endpoint_descriptor *epd)
+{
+    return ((epd->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK) ==
+            USB_ENDPOINT_XFER_INT);
+}
+
+static inline int usb_autopm_set_interface(struct usb_interface *intf)
+{
+    return 0;
+}
+
+static inline int usb_autopm_get_interface(struct usb_interface *intf)
+{
+    return 0;
+}
+
+static inline int usb_autopm_get_interface_async(struct usb_interface *intf)
+{
+    return 0;
+}
+
+static inline void usb_autopm_put_interface(struct usb_interface *intf)
+{ }
+static inline void usb_autopm_put_interface_async(struct usb_interface *intf)
+{ }
+static inline void usb_autopm_enable(struct usb_interface *intf)
+{ }
+static inline void usb_autopm_disable(struct usb_interface *intf)
+{ }
+static inline void usb_mark_last_busy(struct usb_device *udev)
+{ }
+#endif
+
+#if (LINUX_VERSION_CODE <= KERNEL_VERSION( 2,6,24 ))
+#include "usbnet.h"
+#else
+#include <linux/usb/usbnet.h>
+#endif
+
+#if (LINUX_VERSION_CODE > KERNEL_VERSION( 2,6,25 ))
+#include <linux/fdtable.h>
+#else
+#include <linux/file.h>
+#endif
+
+// Used in recursion, defined later below
+struct sGobiUSBNet;
+
+/*=========================================================================*/
+// Struct sReadMemList
+//
+//    Structure that defines an entry in a Read Memory linked list
+/*=========================================================================*/
+typedef struct sReadMemList {
+    /* Data buffer */
+    void *                     mpData;
+
+    /* Transaction ID */
+    u16                        mTransactionID;
+
+    /* Size of data buffer */
+    u16                        mDataSize;
+
+    /* Next entry in linked list */
+    struct sReadMemList *      mpNext;
+
+} sReadMemList;
+
+/*=========================================================================*/
+// Struct sNotifyList
+//
+//    Structure that defines an entry in a Notification linked list
+/*=========================================================================*/
+typedef struct sNotifyList {
+    /* Function to be run when data becomes available */
+    void                  (* mpNotifyFunct)(struct sGobiUSBNet *, u16, void *);
+
+    /* Transaction ID */
+    u16                   mTransactionID;
+
+    /* Data to provide as parameter to mpNotifyFunct */
+    void *                mpData;
+
+    /* Next entry in linked list */
+    struct sNotifyList *  mpNext;
+
+} sNotifyList;
+
+/*=========================================================================*/
+// Struct sURBList
+//
+//    Structure that defines an entry in a URB linked list
+/*=========================================================================*/
+typedef struct sURBList {
+    /* The current URB */
+    struct urb *       mpURB;
+
+    /* Next entry in linked list */
+    struct sURBList *  mpNext;
+
+} sURBList;
+
+/*=========================================================================*/
+// Struct sClientMemList
+//
+//    Structure that defines an entry in a Client Memory linked list
+//      Stores data specific to a Service Type and Client ID
+/*=========================================================================*/
+typedef struct sClientMemList {
+    /* Client ID for this Client */
+    u16                          mClientID;
+
+    /* Linked list of Read entries */
+    /*    Stores data read from device before sending to client */
+    sReadMemList *               mpList;
+
+    /* Linked list of Notification entries */
+    /*    Stores notification functions to be run as data becomes
+          available or the device is removed */
+    sNotifyList *                mpReadNotifyList;
+
+    /* Linked list of URB entries */
+    /*    Stores pointers to outstanding URBs which need canceled
+          when the client is deregistered or the device is removed */
+    sURBList *                   mpURBList;
+
+    /* Next entry in linked list */
+    struct sClientMemList *      mpNext;
+
+    /* Wait queue object for poll() */
+    wait_queue_head_t    mWaitQueue;
+
+} sClientMemList;
+
+/*=========================================================================*/
+// Struct sURBSetupPacket
+//
+//    Structure that defines a USB Setup packet for Control URBs
+//    Taken from USB CDC specifications
+/*=========================================================================*/
+typedef struct sURBSetupPacket {
+    /* Request type */
+    u8    mRequestType;
+
+    /* Request code */
+    u8    mRequestCode;
+
+    /* Value */
+    u16   mValue;
+
+    /* Index */
+    u16   mIndex;
+
+    /* Length of Control URB */
+    u16   mLength;
+
+} sURBSetupPacket;
+
+// Common value for sURBSetupPacket.mLength
+#define DEFAULT_READ_URB_LENGTH 0x1000
+
+#ifdef CONFIG_PM
+#if (LINUX_VERSION_CODE < KERNEL_VERSION( 2,6,29 ))
+/*=========================================================================*/
+// Struct sAutoPM
+//
+//    Structure used to manage AutoPM thread which determines whether the
+//    device is in use or may enter autosuspend.  Also submits net
+//    transmissions asynchronously.
+/*=========================================================================*/
+typedef struct sAutoPM {
+    /* Thread for atomic autopm function */
+    struct task_struct *       mpThread;
+
+    /* Signal for completion when it's time for the thread to work */
+    struct completion          mThreadDoWork;
+
+    /* Time to exit? */
+    bool                       mbExit;
+
+    /* List of URB's queued to be sent to the device */
+    sURBList *                 mpURBList;
+
+    /* URB list lock (for adding and removing elements) */
+    spinlock_t                 mURBListLock;
+
+    /* Length of the URB list */
+    atomic_t                   mURBListLen;
+
+    /* Active URB */
+    struct urb *               mpActiveURB;
+
+    /* Active URB lock (for adding and removing elements) */
+    spinlock_t                 mActiveURBLock;
+
+    /* Duplicate pointer to USB device interface */
+    struct usb_interface *     mpIntf;
+
+} sAutoPM;
+#endif
+#endif /* CONFIG_PM */
+
+/*=========================================================================*/
+// Struct sQMIDev
+//
+//    Structure that defines the data for the QMI device
+/*=========================================================================*/
+typedef struct sQMIDev {
+    /* Device number */
+    dev_t                      mDevNum;
+
+    /* Device class */
+    struct class *             mpDevClass;
+
+    /* cdev struct */
+    struct cdev                mCdev;
+
+    /* is mCdev initialized? */
+    bool                       mbCdevIsInitialized;
+
+    /* Pointer to read URB */
+    struct urb *               mpReadURB;
+
+//#define READ_QMI_URB_ERROR
+#ifdef READ_QMI_URB_ERROR
+    struct timer_list mReadUrbTimer;
+#endif
+
+    /* Read setup packet */
+    sURBSetupPacket *          mpReadSetupPacket;
+
+    /* Read buffer attached to current read URB */
+    void *                     mpReadBuffer;
+
+    /* Inturrupt URB */
+    /*    Used to asynchronously notify when read data is available */
+    struct urb *               mpIntURB;
+
+    /* Buffer used by Inturrupt URB */
+    void *                     mpIntBuffer;
+
+    /* Pointer to memory linked list for all clients */
+    sClientMemList *           mpClientMemList;
+
+    /* Spinlock for client Memory entries */
+    spinlock_t                 mClientMemLock;
+
+    /* Transaction ID associated with QMICTL "client" */
+    atomic_t                   mQMICTLTransactionID;
+
+} sQMIDev;
+
+/*=========================================================================*/
+// Struct sGobiUSBNet
+//
+//    Structure that defines the data associated with the Qualcomm USB device
+/*=========================================================================*/
+typedef struct sGobiUSBNet {
+    atomic_t refcount;
+
+    /* Net device structure */
+    struct usbnet *        mpNetDev;
+#ifdef MEIG_WWAN_QMAP
+    int m_qmap_mode;
+    struct net_device	*mpQmapNetDev[MEIG_WWAN_QMAP];
+#ifdef CONFIG_BRIDGE
+    int m_qmap_bridge_mode[MEIG_WWAN_QMAP];
+#endif
+#endif
+
+#if 1 //def DATA_MODE_RP
+    bool                   mbMdm9x07;
+    bool                   mbMdm9x06;	//for BG96
+    /* QMI "device" work in IP Mode or ETH Mode */
+    bool                   mbRawIPMode;
+#ifdef CONFIG_BRIDGE
+    int m_bridge_mode;
+    uint m_bridge_ipv4;
+    unsigned char     mHostMAC[6];
+#endif
+    int m_qcrmcall_mode;
+#endif
+
+    struct completion mQMIReadyCompletion;
+    bool                   mbQMIReady;
+
+    /* Usb device interface */
+    struct usb_interface * mpIntf;
+
+    /* Pointers to usbnet_open and usbnet_stop functions */
+    int                  (* mpUSBNetOpen)(struct net_device *);
+    int                  (* mpUSBNetStop)(struct net_device *);
+
+    /* Reason(s) why interface is down */
+    /* Used by Gobi*DownReason */
+    unsigned long          mDownReason;
+#define NO_NDIS_CONNECTION    0
+#define CDC_CONNECTION_SPEED  1
+#define DRIVER_SUSPENDED      2
+#define NET_IFACE_STOPPED     3
+
+    /* QMI "device" status */
+    bool                   mbQMIValid;
+
+    bool                   mbDeregisterQMIDevice;
+
+    /* QMI "device" memory */
+    sQMIDev                mQMIDev;
+
+    /* Device MEID */
+    char                   mMEID[14];
+
+#ifdef CONFIG_PM
+#if (LINUX_VERSION_CODE < KERNEL_VERSION( 2,6,29 ))
+    /* AutoPM thread */
+    sAutoPM                mAutoPM;
+#endif
+#endif /* CONFIG_PM */
+} sGobiUSBNet;
+
+/*=========================================================================*/
+// Struct sQMIFilpStorage
+//
+//    Structure that defines the storage each file handle contains
+//       Relates the file handle to a client
+/*=========================================================================*/
+typedef struct sQMIFilpStorage {
+    /* Client ID */
+    u16                  mClientID;
+
+    /* Device pointer */
+    sGobiUSBNet *        mpDev;
+
+} sQMIFilpStorage;
+

root/package/link4all/quectel-CM/Makefile

@@ -0,0 +1,84 @@
+##############################################
+# OpenWrt Makefile for HelloWorld program
+#
+#
+# Most of the variables used here are defined in
+# the include directives below. We just need to
+# specify a basic description of the package,
+# where to build our program, where to find
+# the source files, and where to install the
+# compiled program on the router.
+#
+# Be very careful of spacing in this file.
+# Indents should be tabs, not spaces, and
+# there should be no trailing whitespace in
+# lines that are not commented.
+#
+##############################################
+include $(TOPDIR)/rules.mk
+
+# Name and release number of this package
+PKG_NAME:=quectel-CM
+PKG_RELEASE:=1
+
+
+# This specifies the directory where we're going to build the program. 
+# The root build directory, $(BUILD_DIR), is by default the build_mipsel
+# directory in your OpenWrt SDK directory
+PKG_BUILD_DIR := $(BUILD_DIR)/$(PKG_NAME)
+
+
+include $(INCLUDE_DIR)/package.mk
+ 
+# Specify package information for this program.
+# The variables defined here should be self explanatory.
+# If you are running Kamikaze, delete the DESCRIPTION
+# variable below and uncomment the Kamikaze define
+# directive for the description below
+define Package/quectel-CM
+  SECTION:=utils
+  CATEGORY:=LINK4ALL
+  DEPENDS:=+libpthread +libuci
+  TITLE:=quectel-CM 4g dialer
+endef
+
+
+# Uncomment portion below for Kamikaze and delete DESCRIPTION variable above
+define Package/quectel-CM/description
+   quectel-CM 4g dialer.
+endef
+ 
+# Specify what needs to be done to prepare for building the package.
+# In our case, we need to copy the source files to the build directory.
+# This is NOT the default.  The default uses the PKG_SOURCE_URL and the
+# PKG_SOURCE which is not defined here to download the source from the web.
+# In order to just build a simple program that we have just written, it is
+# much easier to do it this way.
+define Build/Prepare
+	mkdir -p $(PKG_BUILD_DIR)
+	$(CP) ./src/* $(PKG_BUILD_DIR)/
+endef
+
+
+# We do not need to define Build/Configure or Build/Compile directives
+# The defaults are appropriate for compiling a simple program such as this one
+
+
+# Specify where and how to install the program. Since we only have one file,
+# the HelloWorld executable, install it by copying it to the /bin directory on
+# the router. The $(1) variable represents the root directory on the router running
+# OpenWrt. The $(INSTALL_DIR) variable contains a command to prepare the install
+# directory if it does not already exist.  Likewise $(INSTALL_BIN) contains the
+# command to copy the binary file from its current location (in our case the build
+# directory) to the install directory.
+define Package/quectel-CM/install
+	$(INSTALL_DIR) $(1)/bin
+	$(INSTALL_BIN) $(PKG_BUILD_DIR)/quectel-CM $(1)/bin/
+endef
+
+
+# This line executes the necessary commands to compile our program.
+# The above define directives specify all the information needed, but this
+# line calls BuildPackage which in turn actually uses this information to
+# build a package.
+$(eval $(call BuildPackage,quectel-CM))

root/package/link4all/quectel-CM/quectel1.6.0.15_src/GobiNetCM.c

@@ -0,0 +1,242 @@
+/******************************************************************************
+  @file    GobiNetCM.c
+  @brief   GobiNet driver.
+
+  DESCRIPTION
+  Connectivity Management Tool for USB network adapter of Quectel wireless cellular modules.
+
+  INITIALIZATION AND SEQUENCING REQUIREMENTS
+  None.
+
+  ---------------------------------------------------------------------------
+  Copyright (c) 2016 - 2020 Quectel Wireless Solution, Co., Ltd.  All Rights Reserved.
+  Quectel Wireless Solution Proprietary and Confidential.
+  ---------------------------------------------------------------------------
+******************************************************************************/
+#include <stdio.h>
+#include <string.h>
+#include <termios.h>
+#include <stdio.h>
+#include <ctype.h>
+#include "QMIThread.h"
+
+#ifdef CONFIG_GOBINET
+
+// IOCTL to generate a client ID for this service type
+#define IOCTL_QMI_GET_SERVICE_FILE 0x8BE0 + 1
+
+// IOCTL to get the VIDPID of the device
+#define IOCTL_QMI_GET_DEVICE_VIDPID 0x8BE0 + 2
+
+// IOCTL to get the MEID of the device
+#define IOCTL_QMI_GET_DEVICE_MEID 0x8BE0 + 3
+
+static int GobiNetSendQMI(PQCQMIMSG pRequest) {
+    int ret, fd;
+
+    fd = qmiclientId[pRequest->QMIHdr.QMIType];
+
+    if (fd <= 0) {
+        dbg_time("%s QMIType: %d has no clientID", __func__, pRequest->QMIHdr.QMIType);
+        return -ENODEV;
+    }
+
+    // Always ready to write
+    if (1 == 1) {
+        ssize_t nwrites = le16_to_cpu(pRequest->QMIHdr.Length) + 1 - sizeof(QCQMI_HDR);
+        ret = write(fd, &pRequest->MUXMsg, nwrites);
+        if (ret == nwrites) {
+            ret = 0;
+        } else {
+            dbg_time("%s write=%d, errno: %d (%s)", __func__, ret, errno, strerror(errno));
+        }
+    } else {
+        dbg_time("%s poll=%d, errno: %d (%s)", __func__, ret, errno, strerror(errno));
+    }
+
+    return ret;
+}
+
+static int GobiNetGetClientID(const char *qcqmi, UCHAR QMIType) {
+    int ClientId;
+    ClientId = open(qcqmi, O_RDWR | O_NONBLOCK | O_NOCTTY);
+    if (ClientId == -1) {
+        dbg_time("failed to open %s, errno: %d (%s)", qcqmi, errno, strerror(errno));
+        return -1;
+    }
+
+    if (ioctl(ClientId, IOCTL_QMI_GET_SERVICE_FILE, QMIType) != 0) {
+        dbg_time("failed to get ClientID for 0x%02x errno: %d (%s)", QMIType, errno, strerror(errno));
+        close(ClientId);
+        ClientId = 0;
+    }
+
+    switch (QMIType) {
+        case QMUX_TYPE_WDS: dbg_time("Get clientWDS = %d", ClientId); break;
+        case QMUX_TYPE_DMS: dbg_time("Get clientDMS = %d", ClientId); break;
+        case QMUX_TYPE_NAS: dbg_time("Get clientNAS = %d", ClientId); break;
+        case QMUX_TYPE_QOS: dbg_time("Get clientQOS = %d", ClientId); break;
+        case QMUX_TYPE_WMS: dbg_time("Get clientWMS = %d", ClientId); break;
+        case QMUX_TYPE_PDS: dbg_time("Get clientPDS = %d", ClientId); break;
+        case QMUX_TYPE_UIM: dbg_time("Get clientUIM = %d", ClientId); break;
+        case QMUX_TYPE_WDS_ADMIN: dbg_time("Get clientWDA = %d", ClientId);
+        break;
+        default: break;
+    }
+
+    return ClientId;
+}
+
+static int GobiNetDeInit(void) {
+    unsigned int i;
+    for (i = 0; i < sizeof(qmiclientId)/sizeof(qmiclientId[0]); i++)
+    {
+        if (qmiclientId[i] != 0)
+        {
+            close(qmiclientId[i]);
+            qmiclientId[i] = 0;
+        }
+    }
+
+    return 0;
+}
+
+static void * GobiNetThread(void *pData) {
+    PROFILE_T *profile = (PROFILE_T *)pData;
+    const char *qcqmi = (const char *)profile->qmichannel;
+    int wait_for_request_quit = 0;   
+    
+    qmiclientId[QMUX_TYPE_WDS] = GobiNetGetClientID(qcqmi, QMUX_TYPE_WDS);
+    if (profile->enable_ipv6)
+        qmiclientId[QMUX_TYPE_WDS_IPV6] = GobiNetGetClientID(qcqmi, QMUX_TYPE_WDS);
+    qmiclientId[QMUX_TYPE_DMS] = GobiNetGetClientID(qcqmi, QMUX_TYPE_DMS);
+    qmiclientId[QMUX_TYPE_NAS] = GobiNetGetClientID(qcqmi, QMUX_TYPE_NAS);
+    qmiclientId[QMUX_TYPE_UIM] = GobiNetGetClientID(qcqmi, QMUX_TYPE_UIM);
+    if (profile->qmap_mode == 0 || profile->loopback_state) //when QMAP enabled, set data format in GobiNet Driver
+        qmiclientId[QMUX_TYPE_WDS_ADMIN] = GobiNetGetClientID(qcqmi, QMUX_TYPE_WDS_ADMIN);
+
+    //donot check clientWDA, there is only one client for WDA, if quectel-CM is killed by SIGKILL, i cannot get client ID for WDA again!
+    if (qmiclientId[QMUX_TYPE_WDS] == 0)  /*|| (clientWDA == -1)*/ {
+        GobiNetDeInit();
+        dbg_time("%s Failed to open %s, errno: %d (%s)", __func__, qcqmi, errno, strerror(errno));
+        qmidevice_send_event_to_main(RIL_INDICATE_DEVICE_DISCONNECTED);
+        pthread_exit(NULL);
+        return NULL;
+    }
+
+    qmidevice_send_event_to_main(RIL_INDICATE_DEVICE_CONNECTED);
+
+    while (1) {
+        struct pollfd pollfds[16] = {{qmidevice_control_fd[1], POLLIN, 0}};
+        int ne, ret, nevents = 1;
+        unsigned int i;
+
+        for (i = 0; i < sizeof(qmiclientId)/sizeof(qmiclientId[0]); i++)
+        {
+            if (qmiclientId[i] != 0)
+            {
+                pollfds[nevents].fd = qmiclientId[i];
+                pollfds[nevents].events = POLLIN;
+                pollfds[nevents].revents = 0;
+                nevents++;
+            }
+        }
+
+        do {
+            ret = poll(pollfds, nevents, wait_for_request_quit ? 1000: -1);
+         } while ((ret < 0) && (errno == EINTR));
+
+	if (ret == 0 && wait_for_request_quit) {
+    		QmiThreadRecvQMI(NULL); //main thread may pending on QmiThreadSendQMI()
+		continue;
+	}
+
+        if (ret <= 0) {
+            dbg_time("%s poll=%d, errno: %d (%s)", __func__, ret, errno, strerror(errno));
+            break;
+        }
+
+        for (ne = 0; ne < nevents; ne++) {
+            int fd = pollfds[ne].fd;
+            short revents = pollfds[ne].revents;
+
+            if (revents & (POLLERR | POLLHUP | POLLNVAL)) {
+                dbg_time("%s poll err/hup/inval", __func__);
+                dbg_time("epoll fd = %d, events = 0x%04x", fd, revents);
+                if (fd == qmidevice_control_fd[1]) {
+                } else {
+                }
+                if (revents & (POLLERR | POLLHUP | POLLNVAL))
+                    goto __GobiNetThread_quit;
+            }
+
+            if ((revents & POLLIN) == 0)
+                continue;
+
+            if (fd == qmidevice_control_fd[1]) {
+                int triger_event;
+                if (read(fd, &triger_event, sizeof(triger_event)) == sizeof(triger_event)) {
+                    //DBG("triger_event = 0x%x", triger_event);
+                    switch (triger_event) {
+                        case RIL_REQUEST_QUIT:
+                            goto __GobiNetThread_quit;
+                        break;
+                        case SIG_EVENT_STOP:
+                            wait_for_request_quit = 1;   
+                        break;
+                        default:
+                        break;
+                    }
+                }
+                continue;
+            }
+
+            {
+                ssize_t nreads;
+                static UCHAR QMIBuf[4096];
+                PQCQMIMSG pResponse = (PQCQMIMSG)QMIBuf;
+
+                nreads = read(fd, &pResponse->MUXMsg, sizeof(QMIBuf) - sizeof(QCQMI_HDR));
+                if (nreads <= 0)
+                {
+                    dbg_time("%s read=%d errno: %d (%s)",  __func__, (int)nreads, errno, strerror(errno));
+                    break;
+                }
+
+                for (i = 0; i < sizeof(qmiclientId)/sizeof(qmiclientId[0]); i++)
+                {
+                    if (qmiclientId[i] == fd)
+                    {
+                        pResponse->QMIHdr.QMIType = i;
+                    }
+                }
+
+                pResponse->QMIHdr.IFType = USB_CTL_MSG_TYPE_QMI;
+                pResponse->QMIHdr.Length = cpu_to_le16(nreads + sizeof(QCQMI_HDR)  - 1);
+                pResponse->QMIHdr.CtlFlags = 0x00;
+                pResponse->QMIHdr.ClientId = fd & 0xFF;
+
+                QmiThreadRecvQMI(pResponse);
+            }
+        }
+    }
+
+__GobiNetThread_quit:
+    GobiNetDeInit();
+    qmidevice_send_event_to_main(RIL_INDICATE_DEVICE_DISCONNECTED);
+    QmiThreadRecvQMI(NULL); //main thread may pending on QmiThreadSendQMI()
+    dbg_time("%s exit", __func__);
+    pthread_exit(NULL);
+    return NULL;
+}
+
+#else
+static int GobiNetSendQMI(PQCQMIMSG pRequest) {return -1;}
+static void * GobiNetThread(void *pData) {dbg_time("please set CONFIG_GOBINET"); return NULL;}
+#endif
+
+const struct qmi_device_ops gobi_qmidev_ops = {
+	.deinit = GobiNetDeInit,
+	.send = GobiNetSendQMI,
+	.read = GobiNetThread,
+};

root/package/link4all/quectel-CM/quectel1.6.0.15_src/MPQCTL.h

@@ -0,0 +1,377 @@
+/*===========================================================================
+
+                            M P Q C T L. H
+DESCRIPTION:
+
+    This module contains QMI QCTL module.
+
+INITIALIZATION AND SEQUENCING REQUIREMENTS:
+
+Copyright (C) 2011 by Qualcomm Technologies, Incorporated.  All Rights Reserved.
+===========================================================================*/
+
+#ifndef MPQCTL_H
+#define MPQCTL_H
+
+#include "MPQMI.h"
+
+#pragma pack(push, 1)
+
+// ================= QMICTL ==================
+
+// QMICTL Control Flags
+#define QMICTL_CTL_FLAG_CMD     0x00
+#define QMICTL_CTL_FLAG_RSP     0x01
+#define QMICTL_CTL_FLAG_IND     0x02
+
+#if 0
+typedef struct _QMICTL_TRANSACTION_ITEM
+{
+   LIST_ENTRY  List;
+   UCHAR       TransactionId;  // QMICTL transaction id
+   PVOID       Context;        // Adapter or IocDev
+   PIRP        Irp;
+} QMICTL_TRANSACTION_ITEM, *PQMICTL_TRANSACTION_ITEM;
+#endif
+
+typedef struct _QCQMICTL_MSG_HDR
+{
+   UCHAR  CtlFlags;  // 00-cmd, 01-rsp, 10-ind
+   UCHAR  TransactionId;
+   USHORT QMICTLType;
+   USHORT Length;
+} __attribute__ ((packed)) QCQMICTL_MSG_HDR, *PQCQMICTL_MSG_HDR;
+
+#define QCQMICTL_MSG_HDR_SIZE sizeof(QCQMICTL_MSG_HDR)
+
+typedef struct _QCQMICTL_MSG_HDR_RESP
+{
+   UCHAR  CtlFlags;  // 00-cmd, 01-rsp, 10-ind
+   UCHAR  TransactionId;
+   USHORT QMICTLType;
+   USHORT Length;
+   UCHAR  TLVType;          // 0x02 - result code
+   USHORT TLVLength;        // 4
+   USHORT QMUXResult;       // QMI_RESULT_SUCCESS
+                            // QMI_RESULT_FAILURE
+   USHORT QMUXError;        // QMI_ERR_INVALID_ARG
+                            // QMI_ERR_NO_MEMORY
+                            // QMI_ERR_INTERNAL
+                            // QMI_ERR_FAULT
+} __attribute__ ((packed)) QCQMICTL_MSG_HDR_RESP, *PQCQMICTL_MSG_HDR_RESP;
+
+typedef struct _QCQMICTL_MSG
+{
+   UCHAR  CtlFlags;  // 00-cmd, 01-rsp, 10-ind
+   UCHAR  TransactionId;
+   USHORT QMICTLType;
+   USHORT Length;
+   UCHAR  Payload;
+} __attribute__ ((packed)) QCQMICTL_MSG, *PQCQMICTL_MSG;
+
+// TLV Header
+typedef struct _QCQMICTL_TLV_HDR
+{
+   UCHAR  TLVType;
+   USHORT TLVLength;
+} __attribute__ ((packed)) QCQMICTL_TLV_HDR, *PQCQMICTL_TLV_HDR;
+
+#define QCQMICTL_TLV_HDR_SIZE sizeof(QCQMICTL_TLV_HDR)
+
+// QMICTL Type
+#define QMICTL_SET_INSTANCE_ID_REQ    0x0020
+#define QMICTL_SET_INSTANCE_ID_RESP   0x0020
+#define QMICTL_GET_VERSION_REQ        0x0021
+#define QMICTL_GET_VERSION_RESP       0x0021
+#define QMICTL_GET_CLIENT_ID_REQ      0x0022
+#define QMICTL_GET_CLIENT_ID_RESP     0x0022
+#define QMICTL_RELEASE_CLIENT_ID_REQ  0x0023
+#define QMICTL_RELEASE_CLIENT_ID_RESP 0x0023
+#define QMICTL_REVOKE_CLIENT_ID_IND   0x0024
+#define QMICTL_INVALID_CLIENT_ID_IND  0x0025
+#define QMICTL_SET_DATA_FORMAT_REQ    0x0026
+#define QMICTL_SET_DATA_FORMAT_RESP   0x0026
+#define QMICTL_SYNC_REQ               0x0027
+#define QMICTL_SYNC_RESP              0x0027
+#define QMICTL_SYNC_IND               0x0027
+
+#define QMICTL_FLAG_REQUEST    0x00
+#define QMICTL_FLAG_RESPONSE   0x01
+#define QMICTL_FLAG_INDICATION 0x02
+
+// QMICTL Message Definitions
+
+typedef struct _QMICTL_SET_INSTANCE_ID_REQ_MSG
+{
+   UCHAR  CtlFlags;        // QMICTL_FLAG_REQUEST
+   UCHAR  TransactionId;
+   USHORT QMICTLType;      // QMICTL_SET_INSTANCE_ID_REQ
+   USHORT Length;          // 4
+   UCHAR  TLVType;         // QCTLV_TYPE_REQUIRED_PARAMETER
+   USHORT TLVLength;       // 1
+   UCHAR  Value;           // Host-unique QMI instance for this device driver
+} __attribute__ ((packed)) QMICTL_SET_INSTANCE_ID_REQ_MSG, *PQMICTL_SET_INSTANCE_ID_REQ_MSG;
+
+typedef struct _QMICTL_SET_INSTANCE_ID_RESP_MSG
+{
+   UCHAR  CtlFlags;        // QMICTL_FLAG_RESPONSE
+   UCHAR  TransactionId;
+   USHORT QMICTLType;      // QMICTL_SET_INSTANCE_ID_RESP
+   USHORT Length;
+   UCHAR  TLVType;         // QCTLV_TYPE_RESULT_CODE
+   USHORT TLVLength;       // 0x0004
+   USHORT QMIResult;
+   USHORT QMIError;
+   UCHAR  TLV2Type;        // QCTLV_TYPE_REQUIRED_PARAMETER
+   USHORT TLV2Length;      // 0x0002
+   USHORT QMI_ID;          // Upper byte is assigned by MSM,
+                           // lower assigned by host
+} __attribute__ ((packed)) QMICTL_SET_INSTANCE_ID_RESP_MSG, *PQMICTL_SET_INSTANCE_ID_RESP_MSG;
+
+typedef struct _QMICTL_GET_VERSION_REQ_MSG
+{
+   UCHAR  CtlFlags;        // QMICTL_FLAG_REQUEST
+   UCHAR  TransactionId;
+   USHORT QMICTLType;      // QMICTL_GET_VERSION_REQ
+   USHORT Length;          // 0
+   UCHAR  TLVType;         // QCTLV_TYPE_REQUIRED_PARAMETER
+   USHORT TLVLength;       // var
+   UCHAR  QMUXTypes;       // List of one byte QMUX_TYPE values
+                           // 0xFF returns a list of versions for all
+                           // QMUX_TYPEs implemented on the device
+} __attribute__ ((packed)) QMICTL_GET_VERSION_REQ_MSG, *PQMICTL_GET_VERSION_REQ_MSG;
+
+typedef struct _QMUX_TYPE_VERSION_STRUCT
+{
+   UCHAR  QMUXType;
+   USHORT MajorVersion;
+   USHORT MinorVersion;
+} __attribute__ ((packed)) QMUX_TYPE_VERSION_STRUCT, *PQMUX_TYPE_VERSION_STRUCT;
+
+typedef struct _ADDENDUM_VERSION_PREAMBLE
+{
+   UCHAR LabelLength;
+   UCHAR Label;
+} __attribute__ ((packed)) ADDENDUM_VERSION_PREAMBLE, *PADDENDUM_VERSION_PREAMBLE;
+
+#define QMICTL_GET_VERSION_RSP_TLV_TYPE_VERSION     0x01
+#define QMICTL_GET_VERSION_RSP_TLV_TYPE_ADD_VERSION 0x10
+
+typedef struct _QMICTL_GET_VERSION_RESP_MSG
+{
+   UCHAR  CtlFlags;        // QMICTL_FLAG_RESPONSE
+   UCHAR  TransactionId;
+   USHORT QMICTLType;      // QMICTL_GET_VERSION_RESP
+   USHORT Length;
+   UCHAR  TLVType;         // QCTLV_TYPE_RESULT_CODE
+   USHORT TLVLength;       // 0x0004
+   USHORT QMIResult;
+   USHORT QMIError;
+   UCHAR  TLV2Type;        // QCTLV_TYPE_REQUIRED_PARAMETER
+   USHORT TLV2Length;      // var
+   UCHAR  NumElements;     // Num of QMUX_TYPE_VERSION_STRUCT
+   QMUX_TYPE_VERSION_STRUCT TypeVersion[0];
+} __attribute__ ((packed)) QMICTL_GET_VERSION_RESP_MSG, *PQMICTL_GET_VERSION_RESP_MSG;
+
+typedef struct _QMICTL_GET_CLIENT_ID_REQ_MSG
+{
+   UCHAR  CtlFlags;        // QMICTL_FLAG_REQUEST
+   UCHAR  TransactionId;
+   USHORT QMICTLType;      // QMICTL_GET_CLIENT_ID_REQ
+   USHORT Length;
+   UCHAR  TLVType;         // QCTLV_TYPE_REQUIRED_PARAMETER
+   USHORT TLVLength;       // 1
+   UCHAR  QMIType;         // QMUX type
+} __attribute__ ((packed)) QMICTL_GET_CLIENT_ID_REQ_MSG, *PQMICTL_GET_CLIENT_ID_REQ_MSG;
+
+typedef struct _QMICTL_GET_CLIENT_ID_RESP_MSG
+{
+   UCHAR  CtlFlags;        // QMICTL_FLAG_RESPONSE
+   UCHAR  TransactionId;
+   USHORT QMICTLType;      // QMICTL_GET_CLIENT_ID_RESP
+   USHORT Length;
+   UCHAR  TLVType;         // QCTLV_TYPE_RESULT_CODE
+   USHORT TLVLength;       // 0x0004
+   USHORT QMIResult;       // result code
+   USHORT QMIError;        // error code
+   UCHAR  TLV2Type;        // QCTLV_TYPE_REQUIRED_PARAMETER
+   USHORT TLV2Length;      // 2
+   UCHAR  QMIType;
+   UCHAR  ClientId;
+} __attribute__ ((packed)) QMICTL_GET_CLIENT_ID_RESP_MSG, *PQMICTL_GET_CLIENT_ID_RESP_MSG;
+
+typedef struct _QMICTL_RELEASE_CLIENT_ID_REQ_MSG
+{
+   UCHAR  CtlFlags;        // QMICTL_FLAG_REQUEST
+   UCHAR  TransactionId;
+   USHORT QMICTLType;      // QMICTL_RELEASE_CLIENT_ID_REQ
+   USHORT Length;
+   UCHAR  TLVType;         // QCTLV_TYPE_REQUIRED_PARAMETER
+   USHORT TLVLength;       // 0x0002
+   UCHAR  QMIType;
+   UCHAR  ClientId;
+} __attribute__ ((packed)) QMICTL_RELEASE_CLIENT_ID_REQ_MSG, *PQMICTL_RELEASE_CLIENT_ID_REQ_MSG;
+
+typedef struct _QMICTL_RELEASE_CLIENT_ID_RESP_MSG
+{
+   UCHAR  CtlFlags;        // QMICTL_FLAG_RESPONSE
+   UCHAR  TransactionId;
+   USHORT QMICTLType;      // QMICTL_RELEASE_CLIENT_ID_RESP
+   USHORT Length;
+   UCHAR  TLVType;         // QCTLV_TYPE_RESULT_CODE
+   USHORT TLVLength;       // 0x0004
+   USHORT QMIResult;       // result code
+   USHORT QMIError;        // error code
+   UCHAR  TLV2Type;        // QCTLV_TYPE_REQUIRED_PARAMETER
+   USHORT TLV2Length;      // 2
+   UCHAR  QMIType;
+   UCHAR  ClientId;
+} __attribute__ ((packed)) QMICTL_RELEASE_CLIENT_ID_RESP_MSG, *PQMICTL_RELEASE_CLIENT_ID_RESP_MSG;
+
+typedef struct _QMICTL_REVOKE_CLIENT_ID_IND_MSG
+{
+   UCHAR  CtlFlags;        // QMICTL_FLAG_INDICATION
+   UCHAR  TransactionId;
+   USHORT QMICTLType;      // QMICTL_REVOKE_CLIENT_ID_IND
+   USHORT Length;
+   UCHAR  TLVType;         // QCTLV_TYPE_REQUIRED_PARAMETER
+   USHORT TLVLength;       // 0x0002
+   UCHAR  QMIType;
+   UCHAR  ClientId;
+} __attribute__ ((packed)) QMICTL_REVOKE_CLIENT_ID_IND_MSG, *PQMICTL_REVOKE_CLIENT_ID_IND_MSG;
+
+typedef struct _QMICTL_INVALID_CLIENT_ID_IND_MSG
+{
+   UCHAR  CtlFlags;        // QMICTL_FLAG_INDICATION
+   UCHAR  TransactionId;
+   USHORT QMICTLType;      // QMICTL_REVOKE_CLIENT_ID_IND
+   USHORT Length;
+   UCHAR  TLVType;         // QCTLV_TYPE_REQUIRED_PARAMETER
+   USHORT TLVLength;       // 0x0002
+   UCHAR  QMIType;
+   UCHAR  ClientId;
+} __attribute__ ((packed)) QMICTL_INVALID_CLIENT_ID_IND_MSG, *PQMICTL_INVALID_CLIENT_ID_IND_MSG;
+
+typedef struct _QMICTL_SET_DATA_FORMAT_REQ_MSG
+{
+   UCHAR  CtlFlags;        // QMICTL_FLAG_REQUEST
+   UCHAR  TransactionId;
+   USHORT QMICTLType;      // QMICTL_SET_DATA_FORMAT_REQ
+   USHORT Length;
+   UCHAR  TLVType;         // QCTLV_TYPE_REQUIRED_PARAMETER
+   USHORT TLVLength;       // 1
+   UCHAR  DataFormat;      // 0-default; 1-QoS hdr present
+} __attribute__ ((packed)) QMICTL_SET_DATA_FORMAT_REQ_MSG, *PQMICTL_SET_DATA_FORMAT_REQ_MSG;
+
+#ifdef QC_IP_MODE
+#define SET_DATA_FORMAT_TLV_TYPE_LINK_PROTO 0x10
+#define SET_DATA_FORMAT_LINK_PROTO_ETH      0x0001
+#define SET_DATA_FORMAT_LINK_PROTO_IP       0x0002
+typedef struct _QMICTL_SET_DATA_FORMAT_TLV_LINK_PROT
+{
+   UCHAR  TLVType;         // Link-Layer Protocol
+   USHORT TLVLength;       // 2
+   USHORT LinkProt;        // 0x1: ETH; 0x2: IP
+} QMICTL_SET_DATA_FORMAT_TLV_LINK_PROT, *PQMICTL_SET_DATA_FORMAT_TLV_LINK_PROT;
+
+#ifdef QCMP_UL_TLP
+#define SET_DATA_FORMAT_TLV_TYPE_UL_TLP 0x11
+typedef struct _QMICTL_SET_DATA_FORMAT_TLV_UL_TLP
+{
+   UCHAR  TLVType;         // 0x11, Uplink TLP Setting
+   USHORT TLVLength;       // 1
+   UCHAR  UlTlpSetting;    // 0x0: Disable; 0x01: Enable
+} QMICTL_SET_DATA_FORMAT_TLV_UL_TLP, *PQMICTL_SET_DATA_FORMAT_TLV_UL_TLP;
+#endif // QCMP_UL_TLP
+
+#ifdef QCMP_DL_TLP
+#define SET_DATA_FORMAT_TLV_TYPE_DL_TLP 0x13
+typedef struct _QMICTL_SET_DATA_FORMAT_TLV_DL_TLP
+{
+   UCHAR  TLVType;         // 0x11, Uplink TLP Setting
+   USHORT TLVLength;       // 1
+   UCHAR  DlTlpSetting;    // 0x0: Disable; 0x01: Enable
+} QMICTL_SET_DATA_FORMAT_TLV_DL_TLP, *PQMICTL_SET_DATA_FORMAT_TLV_DL_TLP;
+#endif // QCMP_DL_TLP
+
+#endif // QC_IP_MODE
+
+#ifdef MP_QCQOS_ENABLED
+#define SET_DATA_FORMAT_TLV_TYPE_QOS_SETTING 0x12
+typedef struct _QMICTL_SET_DATA_FORMAT_TLV_QOS_SETTING
+{
+   UCHAR  TLVType;       // 0x12, QoS setting
+   USHORT TLVLength;     // 1
+   UCHAR  QosSetting;    // 0x0: Disable; 0x01: Enable
+} QMICTL_SET_DATA_FORMAT_TLV_QOS_SETTING, *PQMICTL_SET_DATA_FORMAT_TLV_QOS_SETTING;
+#endif // MP_QCQOS_ENABLED
+
+typedef struct _QMICTL_SET_DATA_FORMAT_RESP_MSG
+{
+   UCHAR  CtlFlags;        // QMICTL_FLAG_RESPONSE
+   UCHAR  TransactionId;
+   USHORT QMICTLType;      // QMICTL_SET_DATA_FORMAT_RESP
+   USHORT Length;
+   UCHAR  TLVType;         // QCTLV_TYPE_RESULT_CODE
+   USHORT TLVLength;       // 0x0004
+   USHORT QMIResult;       // result code
+   USHORT QMIError;        // error code
+} __attribute__ ((packed)) QMICTL_SET_DATA_FORMAT_RESP_MSG, *PQMICTL_SET_DATA_FORMAT_RESP_MSG;
+
+typedef struct _QMICTL_SYNC_REQ_MSG
+{
+   UCHAR  CtlFlags;        // QMICTL_FLAG_REQUEST
+   UCHAR  TransactionId;
+   USHORT QMICTLType;      // QMICTL_CTL_SYNC_REQ
+   USHORT Length;          // 0
+} __attribute__ ((packed)) QMICTL_SYNC_REQ_MSG, *PQMICTL_SYNC_REQ_MSG;
+
+typedef struct _QMICTL_SYNC_RESP_MSG
+{
+   UCHAR  CtlFlags;        // QMICTL_FLAG_RESPONSE
+   UCHAR  TransactionId;
+   USHORT QMICTLType;      // QMICTL_CTL_SYNC_RESP
+   USHORT Length;
+   UCHAR  TLVType;         // QCTLV_TYPE_RESULT_CODE
+   USHORT TLVLength;       // 0x0004
+   USHORT QMIResult;
+   USHORT QMIError;
+} __attribute__ ((packed)) QMICTL_SYNC_RESP_MSG, *PQMICTL_SYNC_RESP_MSG;
+
+typedef struct _QMICTL_SYNC_IND_MSG
+{
+   UCHAR  CtlFlags;        // QMICTL_FLAG_INDICATION
+   UCHAR  TransactionId;
+   USHORT QMICTLType;      // QMICTL_REVOKE_CLIENT_ID_IND
+   USHORT Length;
+} __attribute__ ((packed)) QMICTL_SYNC_IND_MSG, *PQMICTL_SYNC_IND_MSG;
+
+typedef struct _QMICTL_MSG
+{
+   union
+   {
+      // Message Header
+      QCQMICTL_MSG_HDR                             QMICTLMsgHdr;
+      QCQMICTL_MSG_HDR_RESP                             QMICTLMsgHdrRsp;
+
+      // QMICTL Message
+      QMICTL_SET_INSTANCE_ID_REQ_MSG               SetInstanceIdReq;
+      QMICTL_SET_INSTANCE_ID_RESP_MSG              SetInstanceIdRsp;
+      QMICTL_GET_VERSION_REQ_MSG                   GetVersionReq;
+      QMICTL_GET_VERSION_RESP_MSG                  GetVersionRsp;
+      QMICTL_GET_CLIENT_ID_REQ_MSG                 GetClientIdReq;
+      QMICTL_GET_CLIENT_ID_RESP_MSG                GetClientIdRsp;
+      QMICTL_RELEASE_CLIENT_ID_REQ_MSG             ReleaseClientIdReq;
+      QMICTL_RELEASE_CLIENT_ID_RESP_MSG            ReleaseClientIdRsp;
+      QMICTL_REVOKE_CLIENT_ID_IND_MSG              RevokeClientIdInd;
+      QMICTL_INVALID_CLIENT_ID_IND_MSG             InvalidClientIdInd;
+      QMICTL_SET_DATA_FORMAT_REQ_MSG               SetDataFormatReq;
+      QMICTL_SET_DATA_FORMAT_RESP_MSG              SetDataFormatRsp;
+      QMICTL_SYNC_REQ_MSG                          SyncReq;
+      QMICTL_SYNC_RESP_MSG                         SyncRsp;
+      QMICTL_SYNC_IND_MSG                          SyncInd;
+   };
+} __attribute__ ((packed)) QMICTL_MSG, *PQMICTL_MSG;
+#pragma pack(pop)
+
+#endif // MPQCTL_H

root/package/link4all/quectel-CM/quectel1.6.0.15_src/MPQMI.h

@@ -0,0 +1,302 @@
+/*===========================================================================
+
+                            M P Q M I. H
+DESCRIPTION:
+
+    This module contains forward references to the QMI module.
+
+INITIALIZATION AND SEQUENCING REQUIREMENTS:
+
+Copyright (C) 2011 by Qualcomm Technologies, Incorporated.  All Rights Reserved.
+===========================================================================*/
+/*===========================================================================
+
+                            EDIT HISTORY FOR FILE
+  $Header: //depot/QMI/win/qcdrivers/ndis/MPQMI.h#3 $
+
+when        who    what, where, why
+--------    ---    ----------------------------------------------------------
+11/20/04    hg     Initial version.
+===========================================================================*/
+
+#ifndef USBQMI_H
+#define USBQMI_H
+
+typedef char    CHAR;
+typedef unsigned char   UCHAR;
+typedef short   SHORT;
+typedef unsigned short   USHORT;
+typedef int   INT;
+typedef unsigned int   UINT;
+typedef long    LONG;
+typedef unsigned int   ULONG;
+typedef unsigned long long   ULONG64;
+typedef char   *PCHAR;
+typedef unsigned char   *PUCHAR;
+typedef int   *PINT;
+typedef int   BOOL;
+
+#define TRUE (1 == 1)
+#define FALSE (1 != 1)
+
+#define QMICTL_SUPPORTED_MAJOR_VERSION 1
+#define QMICTL_SUPPORTED_MINOR_VERSION 0
+
+#pragma pack(push, 1)
+
+// ========= USB Control Message ==========
+
+#define USB_CTL_MSG_TYPE_QMI 0x01
+
+// USB Control Message
+typedef struct _QCUSB_CTL_MSG_HDR
+{
+   UCHAR IFType;
+} __attribute__ ((packed)) QCUSB_CTL_MSG_HDR, *PQCUSB_CTL_MSG_HDR;
+
+#define QCUSB_CTL_MSG_HDR_SIZE sizeof(QCUSB_CTL_MSG_HDR)
+
+typedef struct _QCUSB_CTL_MSG
+{
+   UCHAR IFType;
+   UCHAR Message;
+} __attribute__ ((packed)) QCUSB_CTL_MSG, *PQCUSB_CTL_MSG;
+
+#define QCTLV_TYPE_REQUIRED_PARAMETER 0x01
+#define QCTLV_TYPE_RESULT_CODE        0x02
+
+// ================= QMI ==================
+
+// Define QMI Type
+typedef enum _QMI_SERVICE_TYPE
+{
+   QMUX_TYPE_CTL  = 0x00,
+   QMUX_TYPE_WDS  = 0x01,
+   QMUX_TYPE_DMS  = 0x02,
+   QMUX_TYPE_NAS  = 0x03,
+   QMUX_TYPE_QOS  = 0x04,
+   QMUX_TYPE_WMS  = 0x05,
+   QMUX_TYPE_PDS  = 0x06,
+   QMUX_TYPE_UIM  = 0x0B,
+   QMUX_TYPE_WDS_IPV6  = 0x11,
+   QMUX_TYPE_WDS_ADMIN  = 0x1A,
+   QMUX_TYPE_MAX  = 0xFF,
+   QMUX_TYPE_ALL  = 0xFF
+} QMI_SERVICE_TYPE;
+
+typedef enum _QMI_RESULT_CODE_TYPE
+{
+   QMI_RESULT_SUCCESS = 0x0000,
+   QMI_RESULT_FAILURE = 0x0001
+} QMI_RESULT_CODE_TYPE;
+
+typedef enum _QMI_ERROR_CODE_TYPE
+{
+    QMI_ERR_NONE  = 0x0000
+    ,QMI_ERR_MALFORMED_MSG  = 0x0001
+    ,QMI_ERR_NO_MEMORY  = 0x0002
+    ,QMI_ERR_INTERNAL  = 0x0003
+    ,QMI_ERR_ABORTED  = 0x0004
+    ,QMI_ERR_CLIENT_IDS_EXHAUSTED  = 0x0005
+    ,QMI_ERR_UNABORTABLE_TRANSACTION  = 0x0006
+    ,QMI_ERR_INVALID_CLIENT_ID  = 0x0007
+    ,QMI_ERR_NO_THRESHOLDS  = 0x0008
+    ,QMI_ERR_INVALID_HANDLE  = 0x0009
+    ,QMI_ERR_INVALID_PROFILE  = 0x000A
+    ,QMI_ERR_INVALID_PINID  = 0x000B
+    ,QMI_ERR_INCORRECT_PIN  = 0x000C
+    ,QMI_ERR_NO_NETWORK_FOUND  = 0x000D
+    ,QMI_ERR_CALL_FAILED  = 0x000E
+    ,QMI_ERR_OUT_OF_CALL  = 0x000F
+    ,QMI_ERR_NOT_PROVISIONED  = 0x0010
+    ,QMI_ERR_MISSING_ARG  = 0x0011
+    ,QMI_ERR_ARG_TOO_LONG  = 0x0013
+    ,QMI_ERR_INVALID_TX_ID  = 0x0016
+    ,QMI_ERR_DEVICE_IN_USE  = 0x0017
+    ,QMI_ERR_OP_NETWORK_UNSUPPORTED  = 0x0018
+    ,QMI_ERR_OP_DEVICE_UNSUPPORTED  = 0x0019
+    ,QMI_ERR_NO_EFFECT  = 0x001A
+    ,QMI_ERR_NO_FREE_PROFILE  = 0x001B
+    ,QMI_ERR_INVALID_PDP_TYPE  = 0x001C
+    ,QMI_ERR_INVALID_TECH_PREF  = 0x001D
+    ,QMI_ERR_INVALID_PROFILE_TYPE  = 0x001E
+    ,QMI_ERR_INVALID_SERVICE_TYPE  = 0x001F
+    ,QMI_ERR_INVALID_REGISTER_ACTION  = 0x0020
+    ,QMI_ERR_INVALID_PS_ATTACH_ACTION  = 0x0021
+    ,QMI_ERR_AUTHENTICATION_FAILED  = 0x0022
+    ,QMI_ERR_PIN_BLOCKED  = 0x0023
+    ,QMI_ERR_PIN_PERM_BLOCKED  = 0x0024
+    ,QMI_ERR_SIM_NOT_INITIALIZED  = 0x0025
+    ,QMI_ERR_MAX_QOS_REQUESTS_IN_USE  = 0x0026
+    ,QMI_ERR_INCORRECT_FLOW_FILTER  = 0x0027
+    ,QMI_ERR_NETWORK_QOS_UNAWARE  = 0x0028
+    ,QMI_ERR_INVALID_QOS_ID  = 0x0029
+    ,QMI_ERR_INVALID_ID  = 0x0029
+    ,QMI_ERR_REQUESTED_NUM_UNSUPPORTED  = 0x002A
+    ,QMI_ERR_INTERFACE_NOT_FOUND  = 0x002B
+    ,QMI_ERR_FLOW_SUSPENDED  = 0x002C
+    ,QMI_ERR_INVALID_DATA_FORMAT  = 0x002D
+    ,QMI_ERR_GENERAL  = 0x002E
+    ,QMI_ERR_UNKNOWN  = 0x002F
+    ,QMI_ERR_INVALID_ARG  = 0x0030
+    ,QMI_ERR_INVALID_INDEX  = 0x0031
+    ,QMI_ERR_NO_ENTRY  = 0x0032
+    ,QMI_ERR_DEVICE_STORAGE_FULL  = 0x0033
+    ,QMI_ERR_DEVICE_NOT_READY  = 0x0034
+    ,QMI_ERR_NETWORK_NOT_READY  = 0x0035
+    ,QMI_ERR_CAUSE_CODE  = 0x0036
+    ,QMI_ERR_MESSAGE_NOT_SENT  = 0x0037
+    ,QMI_ERR_MESSAGE_DELIVERY_FAILURE  = 0x0038
+    ,QMI_ERR_INVALID_MESSAGE_ID  = 0x0039
+    ,QMI_ERR_ENCODING  = 0x003A
+    ,QMI_ERR_AUTHENTICATION_LOCK  = 0x003B
+    ,QMI_ERR_INVALID_TRANSITION  = 0x003C
+    ,QMI_ERR_NOT_A_MCAST_IFACE  = 0x003D
+    ,QMI_ERR_MAX_MCAST_REQUESTS_IN_USE  = 0x003E
+    ,QMI_ERR_INVALID_MCAST_HANDLE = 0x003F
+    ,QMI_ERR_INVALID_IP_FAMILY_PREF  = 0x0040
+    ,QMI_ERR_SESSION_INACTIVE  = 0x0041
+    ,QMI_ERR_SESSION_INVALID  = 0x0042
+    ,QMI_ERR_SESSION_OWNERSHIP  = 0x0043
+    ,QMI_ERR_INSUFFICIENT_RESOURCES  = 0x0044
+    ,QMI_ERR_DISABLED  = 0x0045
+    ,QMI_ERR_INVALID_OPERATION  = 0x0046
+    ,QMI_ERR_INVALID_QMI_CMD  = 0x0047
+    ,QMI_ERR_TPDU_TYPE  = 0x0048
+    ,QMI_ERR_SMSC_ADDR  = 0x0049
+    ,QMI_ERR_INFO_UNAVAILABLE  = 0x004A
+    ,QMI_ERR_SEGMENT_TOO_LONG  = 0x004B
+    ,QMI_ERR_SEGMENT_ORDER  = 0x004C
+    ,QMI_ERR_BUNDLING_NOT_SUPPORTED  = 0x004D
+    ,QMI_ERR_OP_PARTIAL_FAILURE  = 0x004E
+    ,QMI_ERR_POLICY_MISMATCH  = 0x004F
+    ,QMI_ERR_SIM_FILE_NOT_FOUND  = 0x0050
+    ,QMI_ERR_EXTENDED_INTERNAL  = 0x0051
+    ,QMI_ERR_ACCESS_DENIED  = 0x0052
+    ,QMI_ERR_HARDWARE_RESTRICTED  = 0x0053
+    ,QMI_ERR_ACK_NOT_SENT  = 0x0054
+    ,QMI_ERR_INJECT_TIMEOUT  = 0x0055
+    ,QMI_ERR_INCOMPATIBLE_STATE = 0x005A
+    ,QMI_ERR_FDN_RESTRICT  = 0x005B
+    ,QMI_ERR_SUPS_FAILURE_CAUSE  = 0x005C
+    ,QMI_ERR_NO_RADIO  = 0x005D
+    ,QMI_ERR_NOT_SUPPORTED  = 0x005E
+    ,QMI_ERR_NO_SUBSCRIPTION  = 0x005F
+    ,QMI_ERR_CARD_CALL_CONTROL_FAILED  = 0x0060
+    ,QMI_ERR_NETWORK_ABORTED  = 0x0061
+    ,QMI_ERR_MSG_BLOCKED  = 0x0062
+    ,QMI_ERR_INVALID_SESSION_TYPE  = 0x0064
+    ,QMI_ERR_INVALID_PB_TYPE  = 0x0065
+    ,QMI_ERR_NO_SIM  = 0x0066
+    ,QMI_ERR_PB_NOT_READY  = 0x0067
+    ,QMI_ERR_PIN_RESTRICTION  = 0x0068
+    ,QMI_ERR_PIN2_RESTRICTION  = 0x0069
+    ,QMI_ERR_PUK_RESTRICTION  = 0x006A
+    ,QMI_ERR_PUK2_RESTRICTION  = 0x006B
+    ,QMI_ERR_PB_ACCESS_RESTRICTED  = 0x006C
+    ,QMI_ERR_PB_DELETE_IN_PROG  = 0x006D
+    ,QMI_ERR_PB_TEXT_TOO_LONG  = 0x006E
+    ,QMI_ERR_PB_NUMBER_TOO_LONG  = 0x006F
+    ,QMI_ERR_PB_HIDDEN_KEY_RESTRICTION  = 0x0070
+} QMI_ERROR_CODE_TYPE;
+
+#define QCQMI_CTL_FLAG_SERVICE   0x80
+#define QCQMI_CTL_FLAG_CTL_POINT 0x00
+
+typedef struct _QCQMI_HDR
+{
+   UCHAR  IFType;
+   USHORT Length;
+   UCHAR  CtlFlags;  // reserved
+   UCHAR  QMIType;
+   UCHAR  ClientId;
+} __attribute__ ((packed)) QCQMI_HDR, *PQCQMI_HDR;
+
+#define QCQMI_HDR_SIZE (sizeof(QCQMI_HDR)-1)
+
+typedef struct _QCQMI
+{
+   UCHAR  IFType;
+   USHORT Length;
+   UCHAR  CtlFlags;  // reserved
+   UCHAR  QMIType;
+   UCHAR  ClientId;
+   UCHAR  SDU;
+} __attribute__ ((packed)) QCQMI, *PQCQMI;
+
+typedef struct _QMI_SERVICE_VERSION
+{
+   USHORT Major;
+   USHORT Minor;
+   USHORT AddendumMajor;
+   USHORT AddendumMinor;
+} __attribute__ ((packed)) QMI_SERVICE_VERSION, *PQMI_SERVICE_VERSION;
+
+// ================= QMUX ==================
+
+#define QMUX_MSG_OVERHEAD_BYTES 4  // Type(USHORT) Length(USHORT) -- header
+
+#define QMUX_BROADCAST_CID 0xFF
+
+typedef struct _QCQMUX_HDR
+{
+   UCHAR  CtlFlags;      // 0: single QMUX Msg; 1:
+   USHORT TransactionId;
+} __attribute__ ((packed)) QCQMUX_HDR, *PQCQMUX_HDR;
+
+typedef struct _QCQMUX
+{
+   UCHAR  CtlFlags;      // 0: single QMUX Msg; 1:
+   USHORT TransactionId;
+   UCHAR  Message;  // Type(2), Length(2), Value
+} __attribute__ ((packed)) QCQMUX, *PQCQMUX;
+
+#define QCQMUX_HDR_SIZE sizeof(QCQMUX_HDR)
+
+typedef struct _QCQMUX_MSG_HDR
+{
+   USHORT Type;
+   USHORT Length;
+} __attribute__ ((packed)) QCQMUX_MSG_HDR, *PQCQMUX_MSG_HDR;
+
+#define QCQMUX_MSG_HDR_SIZE sizeof(QCQMUX_MSG_HDR)
+
+typedef struct _QCQMUX_MSG_HDR_RESP
+{
+   USHORT Type;
+   USHORT Length;
+   UCHAR  TLVType;          // 0x02 - result code
+   USHORT TLVLength;        // 4
+   USHORT QMUXResult;       // QMI_RESULT_SUCCESS
+                            // QMI_RESULT_FAILURE
+   USHORT QMUXError;        // QMI_ERR_INVALID_ARG
+                            // QMI_ERR_NO_MEMORY
+                            // QMI_ERR_INTERNAL
+                            // QMI_ERR_FAULT
+} __attribute__ ((packed)) QCQMUX_MSG_HDR_RESP, *PQCQMUX_MSG_HDR_RESP;
+
+typedef struct _QCQMUX_TLV
+{
+   UCHAR Type;
+   USHORT Length;
+   UCHAR  Value;
+} __attribute__ ((packed)) QCQMUX_TLV, *PQCQMUX_TLV;
+
+typedef struct _QMI_TLV_HDR
+{
+   UCHAR  TLVType;
+   USHORT TLVLength;
+} __attribute__ ((packed)) QMI_TLV_HDR, *PQMI_TLV_HDR;
+
+// QMUX Message Definitions -- QMI SDU
+#define QMUX_CTL_FLAG_SINGLE_MSG    0x00
+#define QMUX_CTL_FLAG_COMPOUND_MSG  0x01
+#define QMUX_CTL_FLAG_TYPE_CMD      0x00
+#define QMUX_CTL_FLAG_TYPE_RSP      0x02
+#define QMUX_CTL_FLAG_TYPE_IND      0x04
+#define QMUX_CTL_FLAG_MASK_COMPOUND 0x01
+#define QMUX_CTL_FLAG_MASK_TYPE     0x06 // 00-cmd, 01-rsp, 10-ind
+
+#pragma pack(pop)
+
+#endif // USBQMI_H

root/package/link4all/quectel-CM/quectel1.6.0.15_src/MPQMUX.c

@@ -0,0 +1,446 @@
+/******************************************************************************
+  @file    MPQMUX.c
+  @brief   QMI mux.
+
+  DESCRIPTION
+  Connectivity Management Tool for USB network adapter of Quectel wireless cellular modules.
+
+  INITIALIZATION AND SEQUENCING REQUIREMENTS
+  None.
+
+  ---------------------------------------------------------------------------
+  Copyright (c) 2016 - 2020 Quectel Wireless Solution, Co., Ltd.  All Rights Reserved.
+  Quectel Wireless Solution Proprietary and Confidential.
+  ---------------------------------------------------------------------------
+******************************************************************************/
+
+#include "QMIThread.h"
+static char line[1024];
+static pthread_mutex_t dumpQMIMutex = PTHREAD_MUTEX_INITIALIZER;
+#undef dbg
+#define dbg( format, arg... ) do {if (strlen(line) < sizeof(line)) snprintf(&line[strlen(line)], sizeof(line) - strlen(line), format, ## arg);} while (0)
+
+PQMI_TLV_HDR GetTLV (PQCQMUX_MSG_HDR pQMUXMsgHdr, int TLVType);
+
+typedef struct {
+    UINT type;
+    const char *name;
+} QMI_NAME_T;
+
+#define qmi_name_item(type) {type, #type}
+
+#if 0
+static const QMI_NAME_T qmi_IFType[] = {
+{USB_CTL_MSG_TYPE_QMI, "USB_CTL_MSG_TYPE_QMI"},
+};
+
+static const QMI_NAME_T qmi_CtlFlags[] = {
+qmi_name_item(QMICTL_CTL_FLAG_CMD),
+qmi_name_item(QCQMI_CTL_FLAG_SERVICE),
+};
+
+static const QMI_NAME_T qmi_QMIType[] = {
+qmi_name_item(QMUX_TYPE_CTL),
+qmi_name_item(QMUX_TYPE_WDS),
+qmi_name_item(QMUX_TYPE_DMS),
+qmi_name_item(QMUX_TYPE_NAS),
+qmi_name_item(QMUX_TYPE_QOS),
+qmi_name_item(QMUX_TYPE_WMS),
+qmi_name_item(QMUX_TYPE_PDS),
+qmi_name_item(QMUX_TYPE_WDS_ADMIN),
+};
+
+static const QMI_NAME_T qmi_ctl_CtlFlags[] = {
+qmi_name_item(QMICTL_FLAG_REQUEST),
+qmi_name_item(QMICTL_FLAG_RESPONSE),
+qmi_name_item(QMICTL_FLAG_INDICATION),
+};
+#endif
+
+static const QMI_NAME_T qmux_ctl_QMICTLType[] = {
+// QMICTL Type
+qmi_name_item(QMICTL_SET_INSTANCE_ID_REQ), //    0x0020
+qmi_name_item(QMICTL_SET_INSTANCE_ID_RESP), //   0x0020
+qmi_name_item(QMICTL_GET_VERSION_REQ), //        0x0021
+qmi_name_item(QMICTL_GET_VERSION_RESP), //       0x0021
+qmi_name_item(QMICTL_GET_CLIENT_ID_REQ), //      0x0022
+qmi_name_item(QMICTL_GET_CLIENT_ID_RESP), //     0x0022
+qmi_name_item(QMICTL_RELEASE_CLIENT_ID_REQ), //  0x0023
+qmi_name_item(QMICTL_RELEASE_CLIENT_ID_RESP), // 0x0023
+qmi_name_item(QMICTL_REVOKE_CLIENT_ID_IND), //   0x0024
+qmi_name_item(QMICTL_INVALID_CLIENT_ID_IND), //  0x0025
+qmi_name_item(QMICTL_SET_DATA_FORMAT_REQ), //    0x0026
+qmi_name_item(QMICTL_SET_DATA_FORMAT_RESP), //   0x0026
+qmi_name_item(QMICTL_SYNC_REQ), //               0x0027
+qmi_name_item(QMICTL_SYNC_RESP), //              0x0027
+qmi_name_item(QMICTL_SYNC_IND), //               0x0027
+};
+
+static const QMI_NAME_T qmux_CtlFlags[] = {
+qmi_name_item(QMUX_CTL_FLAG_TYPE_CMD),
+qmi_name_item(QMUX_CTL_FLAG_TYPE_RSP),
+qmi_name_item(QMUX_CTL_FLAG_TYPE_IND),
+};
+
+
+static const QMI_NAME_T qmux_wds_Type[] = {
+qmi_name_item(QMIWDS_SET_EVENT_REPORT_REQ), //           0x0001
+qmi_name_item(QMIWDS_SET_EVENT_REPORT_RESP), //          0x0001
+qmi_name_item(QMIWDS_EVENT_REPORT_IND), //               0x0001
+qmi_name_item(QMIWDS_START_NETWORK_INTERFACE_REQ), //    0x0020
+qmi_name_item(QMIWDS_START_NETWORK_INTERFACE_RESP), //   0x0020
+qmi_name_item(QMIWDS_STOP_NETWORK_INTERFACE_REQ), //     0x0021
+qmi_name_item(QMIWDS_STOP_NETWORK_INTERFACE_RESP), //    0x0021
+qmi_name_item(QMIWDS_GET_PKT_SRVC_STATUS_REQ), //        0x0022
+qmi_name_item(QMIWDS_GET_PKT_SRVC_STATUS_RESP), //       0x0022
+qmi_name_item(QMIWDS_GET_PKT_SRVC_STATUS_IND), //        0x0022  
+qmi_name_item(QMIWDS_GET_CURRENT_CHANNEL_RATE_REQ), //   0x0023  
+qmi_name_item(QMIWDS_GET_CURRENT_CHANNEL_RATE_RESP), //  0x0023  
+qmi_name_item(QMIWDS_GET_PKT_STATISTICS_REQ), //         0x0024  
+qmi_name_item(QMIWDS_GET_PKT_STATISTICS_RESP), //        0x0024  
+qmi_name_item(QMIWDS_MODIFY_PROFILE_SETTINGS_REQ), //    0x0028
+qmi_name_item(QMIWDS_MODIFY_PROFILE_SETTINGS_RESP), //   0x0028
+qmi_name_item(QMIWDS_GET_PROFILE_SETTINGS_REQ), //    0x002B
+qmi_name_item(QMIWDS_GET_PROFILE_SETTINGS_RESP), //   0x002BD
+qmi_name_item(QMIWDS_GET_DEFAULT_SETTINGS_REQ), //       0x002C
+qmi_name_item(QMIWDS_GET_DEFAULT_SETTINGS_RESP), //      0x002C
+qmi_name_item(QMIWDS_GET_RUNTIME_SETTINGS_REQ), //       0x002D
+qmi_name_item(QMIWDS_GET_RUNTIME_SETTINGS_RESP), //      0x002D
+qmi_name_item(QMIWDS_GET_MIP_MODE_REQ), //               0x002F
+qmi_name_item(QMIWDS_GET_MIP_MODE_RESP), //              0x002F
+qmi_name_item(QMIWDS_GET_DATA_BEARER_REQ), //            0x0037
+qmi_name_item(QMIWDS_GET_DATA_BEARER_RESP), //           0x0037
+qmi_name_item(QMIWDS_DUN_CALL_INFO_REQ), //              0x0038
+qmi_name_item(QMIWDS_DUN_CALL_INFO_RESP), //             0x0038
+qmi_name_item(QMIWDS_DUN_CALL_INFO_IND), //              0x0038
+qmi_name_item(QMIWDS_SET_CLIENT_IP_FAMILY_PREF_REQ), //  0x004D  
+qmi_name_item(QMIWDS_SET_CLIENT_IP_FAMILY_PREF_RESP), // 0x004D  
+qmi_name_item(QMIWDS_SET_AUTO_CONNECT_REQ), //  0x0051  
+qmi_name_item(QMIWDS_SET_AUTO_CONNECT_RESP), // 0x0051
+qmi_name_item(QMIWDS_BIND_MUX_DATA_PORT_REQ), //         0x00A2  
+qmi_name_item(QMIWDS_BIND_MUX_DATA_PORT_RESP), //        0x00A2  
+};
+
+static const QMI_NAME_T qmux_dms_Type[] = {
+// ======================= DMS ==============================
+qmi_name_item(QMIDMS_SET_EVENT_REPORT_REQ), //           0x0001
+qmi_name_item(QMIDMS_SET_EVENT_REPORT_RESP), //          0x0001
+qmi_name_item(QMIDMS_EVENT_REPORT_IND), //               0x0001
+qmi_name_item(QMIDMS_GET_DEVICE_CAP_REQ), //             0x0020
+qmi_name_item(QMIDMS_GET_DEVICE_CAP_RESP), //            0x0020
+qmi_name_item(QMIDMS_GET_DEVICE_MFR_REQ), //             0x0021
+qmi_name_item(QMIDMS_GET_DEVICE_MFR_RESP), //            0x0021
+qmi_name_item(QMIDMS_GET_DEVICE_MODEL_ID_REQ), //        0x0022
+qmi_name_item(QMIDMS_GET_DEVICE_MODEL_ID_RESP), //       0x0022
+qmi_name_item(QMIDMS_GET_DEVICE_REV_ID_REQ), //          0x0023
+qmi_name_item(QMIDMS_GET_DEVICE_REV_ID_RESP), //         0x0023
+qmi_name_item(QMIDMS_GET_MSISDN_REQ), //                 0x0024
+qmi_name_item(QMIDMS_GET_MSISDN_RESP), //                0x0024
+qmi_name_item(QMIDMS_GET_DEVICE_SERIAL_NUMBERS_REQ), //  0x0025
+qmi_name_item(QMIDMS_GET_DEVICE_SERIAL_NUMBERS_RESP), // 0x0025
+qmi_name_item(QMIDMS_UIM_SET_PIN_PROTECTION_REQ), //     0x0027
+qmi_name_item(QMIDMS_UIM_SET_PIN_PROTECTION_RESP), //    0x0027
+qmi_name_item(QMIDMS_UIM_VERIFY_PIN_REQ), //             0x0028
+qmi_name_item(QMIDMS_UIM_VERIFY_PIN_RESP), //            0x0028
+qmi_name_item(QMIDMS_UIM_UNBLOCK_PIN_REQ), //            0x0029
+qmi_name_item(QMIDMS_UIM_UNBLOCK_PIN_RESP), //           0x0029
+qmi_name_item(QMIDMS_UIM_CHANGE_PIN_REQ), //             0x002A
+qmi_name_item(QMIDMS_UIM_CHANGE_PIN_RESP), //            0x002A
+qmi_name_item(QMIDMS_UIM_GET_PIN_STATUS_REQ), //         0x002B
+qmi_name_item(QMIDMS_UIM_GET_PIN_STATUS_RESP), //        0x002B
+qmi_name_item(QMIDMS_GET_DEVICE_HARDWARE_REV_REQ), //    0x002C
+qmi_name_item(QMIDMS_GET_DEVICE_HARDWARE_REV_RESP), //   0x002C
+qmi_name_item(QMIDMS_GET_OPERATING_MODE_REQ), //         0x002D 
+qmi_name_item(QMIDMS_GET_OPERATING_MODE_RESP), //        0x002D 
+qmi_name_item(QMIDMS_SET_OPERATING_MODE_REQ), //         0x002E 
+qmi_name_item(QMIDMS_SET_OPERATING_MODE_RESP), //        0x002E 
+qmi_name_item(QMIDMS_GET_ACTIVATED_STATUS_REQ), //       0x0031 
+qmi_name_item(QMIDMS_GET_ACTIVATED_STATUS_RESP), //      0x0031 
+qmi_name_item(QMIDMS_ACTIVATE_AUTOMATIC_REQ), //         0x0032
+qmi_name_item(QMIDMS_ACTIVATE_AUTOMATIC_RESP), //        0x0032
+qmi_name_item(QMIDMS_ACTIVATE_MANUAL_REQ), //            0x0033
+qmi_name_item(QMIDMS_ACTIVATE_MANUAL_RESP), //           0x0033
+qmi_name_item(QMIDMS_UIM_GET_ICCID_REQ), //              0x003C 
+qmi_name_item(QMIDMS_UIM_GET_ICCID_RESP), //             0x003C 
+qmi_name_item(QMIDMS_UIM_GET_CK_STATUS_REQ), //          0x0040
+qmi_name_item(QMIDMS_UIM_GET_CK_STATUS_RESP), //         0x0040
+qmi_name_item(QMIDMS_UIM_SET_CK_PROTECTION_REQ), //      0x0041
+qmi_name_item(QMIDMS_UIM_SET_CK_PROTECTION_RESP), //     0x0041
+qmi_name_item(QMIDMS_UIM_UNBLOCK_CK_REQ), //             0x0042
+qmi_name_item(QMIDMS_UIM_UNBLOCK_CK_RESP), //            0x0042
+qmi_name_item(QMIDMS_UIM_GET_IMSI_REQ), //               0x0043 
+qmi_name_item(QMIDMS_UIM_GET_IMSI_RESP), //              0x0043 
+qmi_name_item(QMIDMS_UIM_GET_STATE_REQ), //              0x0044 
+qmi_name_item(QMIDMS_UIM_GET_STATE_RESP), //             0x0044 
+qmi_name_item(QMIDMS_GET_BAND_CAP_REQ), //               0x0045 
+qmi_name_item(QMIDMS_GET_BAND_CAP_RESP), //              0x0045 
+};
+
+static const QMI_NAME_T qmux_nas_Type[] = {
+// ======================= NAS ==============================
+qmi_name_item(QMINAS_SET_EVENT_REPORT_REQ), //             0x0002
+qmi_name_item(QMINAS_SET_EVENT_REPORT_RESP), //            0x0002
+qmi_name_item(QMINAS_EVENT_REPORT_IND), //                 0x0002
+qmi_name_item(QMINAS_GET_SIGNAL_STRENGTH_REQ), //          0x0020
+qmi_name_item(QMINAS_GET_SIGNAL_STRENGTH_RESP), //         0x0020
+qmi_name_item(QMINAS_PERFORM_NETWORK_SCAN_REQ), //         0x0021
+qmi_name_item(QMINAS_PERFORM_NETWORK_SCAN_RESP), //        0x0021
+qmi_name_item(QMINAS_INITIATE_NW_REGISTER_REQ), //         0x0022
+qmi_name_item(QMINAS_INITIATE_NW_REGISTER_RESP), //        0x0022
+qmi_name_item(QMINAS_INITIATE_ATTACH_REQ), //              0x0023
+qmi_name_item(QMINAS_INITIATE_ATTACH_RESP), //             0x0023
+qmi_name_item(QMINAS_GET_SERVING_SYSTEM_REQ), //           0x0024
+qmi_name_item(QMINAS_GET_SERVING_SYSTEM_RESP), //          0x0024
+qmi_name_item(QMINAS_SERVING_SYSTEM_IND), //               0x0024
+qmi_name_item(QMINAS_GET_HOME_NETWORK_REQ), //             0x0025
+qmi_name_item(QMINAS_GET_HOME_NETWORK_RESP), //            0x0025
+qmi_name_item(QMINAS_GET_PREFERRED_NETWORK_REQ), //        0x0026
+qmi_name_item(QMINAS_GET_PREFERRED_NETWORK_RESP), //       0x0026
+qmi_name_item(QMINAS_SET_PREFERRED_NETWORK_REQ), //        0x0027
+qmi_name_item(QMINAS_SET_PREFERRED_NETWORK_RESP), //       0x0027
+qmi_name_item(QMINAS_GET_FORBIDDEN_NETWORK_REQ), //        0x0028
+qmi_name_item(QMINAS_GET_FORBIDDEN_NETWORK_RESP), //       0x0028
+qmi_name_item(QMINAS_SET_FORBIDDEN_NETWORK_REQ), //        0x0029
+qmi_name_item(QMINAS_SET_FORBIDDEN_NETWORK_RESP), //       0x0029
+qmi_name_item(QMINAS_SET_TECHNOLOGY_PREF_REQ), //          0x002A
+qmi_name_item(QMINAS_SET_TECHNOLOGY_PREF_RESP), //         0x002A
+qmi_name_item(QMINAS_GET_RF_BAND_INFO_REQ), //             0x0031
+qmi_name_item(QMINAS_GET_RF_BAND_INFO_RESP), //            0x0031
+qmi_name_item(QMINAS_GET_PLMN_NAME_REQ), //                0x0044
+qmi_name_item(QMINAS_GET_PLMN_NAME_RESP), //               0x0044
+qmi_name_item(QUECTEL_PACKET_TRANSFER_START_IND), //                0X100
+qmi_name_item(QUECTEL_PACKET_TRANSFER_END_IND), //               0X101
+qmi_name_item(QMINAS_GET_SYS_INFO_REQ), //                 0x004D
+qmi_name_item(QMINAS_GET_SYS_INFO_RESP), //                0x004D
+qmi_name_item(QMINAS_SYS_INFO_IND), //                     0x004D
+};
+
+static const QMI_NAME_T qmux_wms_Type[] = {
+// ======================= WMS ==============================
+qmi_name_item(QMIWMS_SET_EVENT_REPORT_REQ), //           0x0001
+qmi_name_item(QMIWMS_SET_EVENT_REPORT_RESP), //          0x0001
+qmi_name_item(QMIWMS_EVENT_REPORT_IND), //               0x0001
+qmi_name_item(QMIWMS_RAW_SEND_REQ), //                   0x0020
+qmi_name_item(QMIWMS_RAW_SEND_RESP), //                  0x0020
+qmi_name_item(QMIWMS_RAW_WRITE_REQ), //                  0x0021
+qmi_name_item(QMIWMS_RAW_WRITE_RESP), //                 0x0021
+qmi_name_item(QMIWMS_RAW_READ_REQ), //                   0x0022
+qmi_name_item(QMIWMS_RAW_READ_RESP), //                  0x0022
+qmi_name_item(QMIWMS_MODIFY_TAG_REQ), //                 0x0023
+qmi_name_item(QMIWMS_MODIFY_TAG_RESP), //                0x0023
+qmi_name_item(QMIWMS_DELETE_REQ), //                     0x0024
+qmi_name_item(QMIWMS_DELETE_RESP), //                    0x0024
+qmi_name_item(QMIWMS_GET_MESSAGE_PROTOCOL_REQ), //       0x0030
+qmi_name_item(QMIWMS_GET_MESSAGE_PROTOCOL_RESP), //      0x0030
+qmi_name_item(QMIWMS_LIST_MESSAGES_REQ), //              0x0031
+qmi_name_item(QMIWMS_LIST_MESSAGES_RESP), //             0x0031
+qmi_name_item(QMIWMS_GET_SMSC_ADDRESS_REQ), //           0x0034
+qmi_name_item(QMIWMS_GET_SMSC_ADDRESS_RESP), //          0x0034
+qmi_name_item(QMIWMS_SET_SMSC_ADDRESS_REQ), //           0x0035
+qmi_name_item(QMIWMS_SET_SMSC_ADDRESS_RESP), //          0x0035
+qmi_name_item(QMIWMS_GET_STORE_MAX_SIZE_REQ), //         0x0036
+qmi_name_item(QMIWMS_GET_STORE_MAX_SIZE_RESP), //        0x0036
+};
+
+static const QMI_NAME_T qmux_wds_admin_Type[] = {
+qmi_name_item(QMIWDS_ADMIN_SET_DATA_FORMAT_REQ), //      0x0020
+qmi_name_item(QMIWDS_ADMIN_SET_DATA_FORMAT_RESP), //     0x0020
+qmi_name_item(QMIWDS_ADMIN_GET_DATA_FORMAT_REQ), //      0x0021
+qmi_name_item(QMIWDS_ADMIN_GET_DATA_FORMAT_RESP), //     0x0021
+qmi_name_item(QMIWDS_ADMIN_SET_QMAP_SETTINGS_REQ), //    0x002B
+qmi_name_item(QMIWDS_ADMIN_SET_QMAP_SETTINGS_RESP), //   0x002B
+qmi_name_item(QMIWDS_ADMIN_GET_QMAP_SETTINGS_REQ), //    0x002C
+qmi_name_item(QMIWDS_ADMIN_GET_QMAP_SETTINGS_RESP), //   0x002C
+qmi_name_item(QMI_WDA_SET_LOOPBACK_CONFIG_REQ), //	 0x002F
+qmi_name_item(QMI_WDA_SET_LOOPBACK_CONFIG_RESP), //	 0x002F
+qmi_name_item(QMI_WDA_SET_LOOPBACK_CONFIG_IND), //	 0x002F
+};
+
+static const QMI_NAME_T qmux_uim_Type[] = {
+qmi_name_item( QMIUIM_READ_TRANSPARENT_REQ), //      0x0020
+qmi_name_item( QMIUIM_READ_TRANSPARENT_RESP), //     0x0020
+qmi_name_item( QMIUIM_READ_TRANSPARENT_IND), //      0x0020
+qmi_name_item( QMIUIM_READ_RECORD_REQ), //           0x0021
+qmi_name_item( QMIUIM_READ_RECORD_RESP), //          0x0021
+qmi_name_item( QMIUIM_READ_RECORD_IND), //           0x0021
+qmi_name_item( QMIUIM_WRITE_TRANSPARENT_REQ), //     0x0022
+qmi_name_item( QMIUIM_WRITE_TRANSPARENT_RESP), //    0x0022
+qmi_name_item( QMIUIM_WRITE_TRANSPARENT_IND), //     0x0022
+qmi_name_item( QMIUIM_WRITE_RECORD_REQ), //          0x0023
+qmi_name_item( QMIUIM_WRITE_RECORD_RESP), //         0x0023
+qmi_name_item( QMIUIM_WRITE_RECORD_IND), //          0x0023
+qmi_name_item( QMIUIM_SET_PIN_PROTECTION_REQ), //    0x0025
+qmi_name_item( QMIUIM_SET_PIN_PROTECTION_RESP), //   0x0025
+qmi_name_item( QMIUIM_SET_PIN_PROTECTION_IND), //    0x0025
+qmi_name_item( QMIUIM_VERIFY_PIN_REQ), //            0x0026
+qmi_name_item( QMIUIM_VERIFY_PIN_RESP), //           0x0026
+qmi_name_item( QMIUIM_VERIFY_PIN_IND), //            0x0026
+qmi_name_item( QMIUIM_UNBLOCK_PIN_REQ), //           0x0027
+qmi_name_item( QMIUIM_UNBLOCK_PIN_RESP), //          0x0027
+qmi_name_item( QMIUIM_UNBLOCK_PIN_IND), //           0x0027
+qmi_name_item( QMIUIM_CHANGE_PIN_REQ), //            0x0028
+qmi_name_item( QMIUIM_CHANGE_PIN_RESP), //           0x0028
+qmi_name_item( QMIUIM_CHANGE_PIN_IND), //            0x0028
+qmi_name_item( QMIUIM_DEPERSONALIZATION_REQ), //     0x0029
+qmi_name_item( QMIUIM_DEPERSONALIZATION_RESP), //    0x0029
+qmi_name_item( QMIUIM_EVENT_REG_REQ), //             0x002E
+qmi_name_item( QMIUIM_EVENT_REG_RESP), //            0x002E
+qmi_name_item( QMIUIM_GET_CARD_STATUS_REQ), //       0x002F
+qmi_name_item( QMIUIM_GET_CARD_STATUS_RESP), //      0x002F
+qmi_name_item( QMIUIM_STATUS_CHANGE_IND), //         0x0032
+};
+
+static const char * qmi_name_get(const QMI_NAME_T *table, size_t size, int type, const char *tag) {
+    static char unknow[40];
+    size_t i;
+
+    if (qmux_CtlFlags == table) {
+        if (!strcmp(tag, "_REQ"))
+            tag = "_CMD";
+        else  if (!strcmp(tag, "_RESP"))
+            tag = "_RSP";
+    }
+    
+    for (i = 0; i < size; i++) {
+        if (table[i].type == (UINT)type) {
+            if (!tag || (strstr(table[i].name, tag)))
+                return table[i].name;
+        }
+    }
+    sprintf(unknow, "unknow_%x", type);
+    return unknow;
+}
+
+#define QMI_NAME(table, type) qmi_name_get(table, sizeof(table) / sizeof(table[0]), type, 0)
+#define QMUX_NAME(table, type, tag) qmi_name_get(table, sizeof(table) / sizeof(table[0]), type, tag)
+
+void dump_tlv(PQCQMUX_MSG_HDR pQMUXMsgHdr) {
+    int TLVFind = 0;
+    int i;
+    //dbg("QCQMUX_TLV-----------------------------------\n");
+    //dbg("{Type,\tLength,\tValue}\n");
+
+    while (1) {
+        PQMI_TLV_HDR TLVHdr = GetTLV(pQMUXMsgHdr, 0x1000 + (++TLVFind));
+        if (TLVHdr == NULL)
+            break;
+
+        //if ((TLVHdr->TLVType == 0x02) && ((USHORT *)(TLVHdr+1))[0])
+        {        
+            dbg("{%02x,\t%04x,\t", TLVHdr->TLVType, le16_to_cpu(TLVHdr->TLVLength));
+            for (i = 0; i < le16_to_cpu(TLVHdr->TLVLength); i++) {
+                dbg("%02x ", ((UCHAR *)(TLVHdr+1))[i]);
+            }
+            dbg("}\n");
+        }
+    }  // while
+}
+
+void dump_ctl(PQCQMICTL_MSG_HDR CTLHdr) {
+    const char *tag;
+    
+    //dbg("QCQMICTL_MSG--------------------------------------------\n");
+    //dbg("CtlFlags:           %02x\t\t%s\n", CTLHdr->CtlFlags, QMI_NAME(qmi_ctl_CtlFlags, CTLHdr->CtlFlags));
+   dbg("TransactionId:      %02x\n", CTLHdr->TransactionId);
+        switch (CTLHdr->CtlFlags) {
+            case QMICTL_FLAG_REQUEST: tag = "_REQ"; break;
+            case QMICTL_FLAG_RESPONSE: tag = "_RESP"; break;
+            case QMICTL_FLAG_INDICATION: tag = "_IND"; break;
+            default: tag = 0; break;
+       }
+        dbg("QMICTLType:         %04x\t%s\n", le16_to_cpu(CTLHdr->QMICTLType),
+        QMUX_NAME(qmux_ctl_QMICTLType, le16_to_cpu(CTLHdr->QMICTLType), tag));     
+        dbg("Length:             %04x\n", le16_to_cpu(CTLHdr->Length));
+
+     dump_tlv((PQCQMUX_MSG_HDR)(&CTLHdr->QMICTLType));
+}
+
+int dump_qmux(QMI_SERVICE_TYPE serviceType, PQCQMUX_HDR QMUXHdr) {
+    PQCQMUX_MSG_HDR QMUXMsgHdr = (PQCQMUX_MSG_HDR) (QMUXHdr + 1);
+    CHAR *tag;
+
+    //dbg("QCQMUX--------------------------------------------\n");
+    switch (QMUXHdr->CtlFlags&QMUX_CTL_FLAG_MASK_TYPE) {
+        case QMUX_CTL_FLAG_TYPE_CMD: tag = "_REQ"; break;
+        case QMUX_CTL_FLAG_TYPE_RSP: tag = "_RESP"; break;
+        case QMUX_CTL_FLAG_TYPE_IND: tag = "_IND"; break;
+        default: tag = 0; break;
+    }
+    //dbg("CtlFlags:           %02x\t\t%s\n", QMUXHdr->CtlFlags, QMUX_NAME(qmux_CtlFlags, QMUXHdr->CtlFlags, tag));
+    dbg("TransactionId:    %04x\n", le16_to_cpu(QMUXHdr->TransactionId));
+
+    //dbg("QCQMUX_MSG_HDR-----------------------------------\n");
+    switch (serviceType) {
+        case QMUX_TYPE_DMS:
+            dbg("Type:               %04x\t%s\n", le16_to_cpu(QMUXMsgHdr->Type),
+            QMUX_NAME(qmux_dms_Type, le16_to_cpu(QMUXMsgHdr->Type), tag));
+        break;
+        case QMUX_TYPE_NAS:
+            dbg("Type:               %04x\t%s\n", le16_to_cpu(QMUXMsgHdr->Type),
+            QMUX_NAME(qmux_nas_Type, le16_to_cpu(QMUXMsgHdr->Type), tag));
+        break;
+        case QMUX_TYPE_WDS:
+        case QMUX_TYPE_WDS_IPV6:
+            dbg("Type:               %04x\t%s\n", le16_to_cpu(QMUXMsgHdr->Type),
+            QMUX_NAME(qmux_wds_Type, le16_to_cpu(QMUXMsgHdr->Type), tag));
+        break;
+        case QMUX_TYPE_WMS:
+            dbg("Type:               %04x\t%s\n", le16_to_cpu(QMUXMsgHdr->Type),
+            QMUX_NAME(qmux_wms_Type, le16_to_cpu(QMUXMsgHdr->Type), tag));
+        break;
+        case QMUX_TYPE_WDS_ADMIN:
+            dbg("Type:               %04x\t%s\n", le16_to_cpu(QMUXMsgHdr->Type),
+            QMUX_NAME(qmux_wds_admin_Type, le16_to_cpu(QMUXMsgHdr->Type), tag));
+        break;
+        case QMUX_TYPE_UIM:
+            dbg("Type:               %04x\t%s\n", le16_to_cpu(QMUXMsgHdr->Type),
+            QMUX_NAME(qmux_uim_Type, le16_to_cpu(QMUXMsgHdr->Type), tag));
+        break;
+        case QMUX_TYPE_PDS:
+        case QMUX_TYPE_QOS:
+        case QMUX_TYPE_CTL:                
+        default:
+            dbg("Type:               %04x\t%s\n", le16_to_cpu(QMUXMsgHdr->Type), "PDS/QOS/CTL/unknown!");
+        break;    
+    }
+    dbg("Length:             %04x\n", le16_to_cpu(QMUXMsgHdr->Length));
+
+    dump_tlv(QMUXMsgHdr);
+    
+    return 0;
+}
+
+void dump_qmi(void *dataBuffer, int dataLen) 
+{
+    PQCQMI_HDR QMIHdr = (PQCQMI_HDR)dataBuffer;
+    PQCQMUX_HDR QMUXHdr = (PQCQMUX_HDR) (QMIHdr + 1);
+    PQCQMICTL_MSG_HDR CTLHdr =  (PQCQMICTL_MSG_HDR) (QMIHdr + 1);
+
+    int i;
+
+    if (!debug_qmi)
+        return;
+
+    pthread_mutex_lock(&dumpQMIMutex);
+    line[0] = 0;
+    for (i = 0; i < dataLen; i++) {
+        dbg("%02x ", ((unsigned char *)dataBuffer)[i]);
+    }
+    dbg_time("%s", line);
+    line[0] = 0;
+    
+    //dbg("QCQMI_HDR-----------------------------------------");
+    //dbg("IFType:             %02x\t\t%s", QMIHdr->IFType, QMI_NAME(qmi_IFType, QMIHdr->IFType));
+    //dbg("Length:             %04x", le16_to_cpu(QMIHdr->Length));
+    //dbg("CtlFlags:           %02x\t\t%s", QMIHdr->CtlFlags, QMI_NAME(qmi_CtlFlags, QMIHdr->CtlFlags));
+    //dbg("QMIType:            %02x\t\t%s", QMIHdr->QMIType, QMI_NAME(qmi_QMIType, QMIHdr->QMIType));
+    //dbg("ClientId:           %02x", QMIHdr->ClientId);
+
+    if (QMIHdr->QMIType == QMUX_TYPE_CTL) {
+        dump_ctl(CTLHdr);
+    } else {
+        dump_qmux(QMIHdr->QMIType, QMUXHdr);
+    }
+    dbg_time("%s", line);
+    pthread_mutex_unlock(&dumpQMIMutex);
+}

root/package/link4all/quectel-CM/quectel1.6.0.15_src/Makefile

@@ -0,0 +1,24 @@
+#CROSS_COMPILE=arm-hisiv100nptl-linux-
+# ifneq ($(CROSS_COMPILE),)
+# CROSS-COMPILE:=$(CROSS_COMPILE)
+# endif
+
+# CC:=$(CROSS-COMPILE)gcc
+# LD:=$(CROSS-COMPILE)ld
+
+# release: clean
+# 	$(CC) -Wall -s QmiWwanCM.c GobiNetCM.c main.c MPQMUX.c QMIThread.c util.c udhcpc.c -o simcom-cm -lpthread
+
+# debug: clean
+# 	$(CC) -Wall -g QmiWwanCM.c GobiNetCM.c main.c MPQMUX.c QMIThread.c util.c udhcpc.c -o simcom-cm -lpthread
+
+# clean:
+# 	rm -rf simcom-cm *~
+
+
+quectel-CM:clean
+	$(CC) -Wall -s QmiWwanCM.c GobiNetCM.c main.c MPQMUX.c QMIThread.c util.c udhcpc.c qmap_bridge_mode.c device.c mbim-cm.c -o quectel-CM -lpthread
+
+clean:
+	rm -rf quectel-CM *~
+

root/package/link4all/quectel-CM/quectel1.6.0.15_src/NOTICE

@@ -0,0 +1,7 @@
+This program is totally open souce code, and public domain software for customers of Quectel company.
+
+The APIs of QMI WWAMN interfaces are defined by Qualcomm. And this program complies with Qualcomm QMI WWAN interfaces specification.
+
+Customers are free to modify the source codes and redistribute them.
+
+For those who is not Quectel's customer, all rights are closed, and any copying and commercial development over this progrma is not allowed. 

root/package/link4all/quectel-CM/quectel1.6.0.15_src/QMIThread.h

@@ -0,0 +1,310 @@
+#ifndef __QMI_THREAD_H__
+#define __QMI_THREAD_H__
+
+#define CONFIG_GOBINET
+#define CONFIG_QMIWWAN
+#define CONFIG_SIM
+#define CONFIG_APN
+#define CONFIG_VERSION
+// #define CONFIG_SIGNALINFO
+#define CONFIG_DEFAULT_PDP 1
+//#define CONFIG_IMSI_ICCID
+#define QUECTEL_UL_DATA_AGG
+
+#include <stdio.h>
+#include <string.h>
+#include <termios.h>
+#include <stdio.h>
+#include <ctype.h>
+#include <time.h>
+#include <fcntl.h>
+#include <signal.h>
+#include <errno.h>
+#include <string.h>
+#include <stdlib.h>
+#include <unistd.h>
+#include <errno.h>
+#include <pthread.h>
+#include <sys/types.h>
+#include <sys/stat.h>
+#include <sys/epoll.h>
+#include <poll.h>
+#include <sys/ioctl.h>
+#include <sys/socket.h>
+#include <stddef.h>
+
+#include "MPQMI.h"
+#include "MPQCTL.h"
+#include "MPQMUX.h"
+#include "util.h"
+
+#define DEVICE_CLASS_UNKNOWN           0
+#define DEVICE_CLASS_CDMA              1
+#define DEVICE_CLASS_GSM               2
+
+#define WWAN_DATA_CLASS_NONE            0x00000000
+#define WWAN_DATA_CLASS_GPRS            0x00000001
+#define WWAN_DATA_CLASS_EDGE            0x00000002 /* EGPRS */
+#define WWAN_DATA_CLASS_UMTS            0x00000004
+#define WWAN_DATA_CLASS_HSDPA           0x00000008
+#define WWAN_DATA_CLASS_HSUPA           0x00000010
+#define WWAN_DATA_CLASS_LTE             0x00000020
+#define WWAN_DATA_CLASS_5G_NSA        0x00000040
+#define WWAN_DATA_CLASS_5G_SA        0x00000080
+#define WWAN_DATA_CLASS_1XRTT           0x00010000
+#define WWAN_DATA_CLASS_1XEVDO          0x00020000
+#define WWAN_DATA_CLASS_1XEVDO_REVA     0x00040000
+#define WWAN_DATA_CLASS_1XEVDV          0x00080000
+#define WWAN_DATA_CLASS_3XRTT           0x00100000
+#define WWAN_DATA_CLASS_1XEVDO_REVB     0x00200000 /* for future use */
+#define WWAN_DATA_CLASS_UMB             0x00400000
+#define WWAN_DATA_CLASS_CUSTOM          0x80000000
+
+struct wwan_data_class_str {
+    ULONG class;
+    CHAR *str;
+};
+
+#pragma pack(push, 1)
+
+typedef struct _QCQMIMSG {
+    QCQMI_HDR QMIHdr;
+    union {
+        QMICTL_MSG CTLMsg;
+        QMUX_MSG MUXMsg;
+    };
+} __attribute__ ((packed)) QCQMIMSG, *PQCQMIMSG;
+
+typedef struct __IPV4 {
+    uint32_t Address;
+    uint32_t Gateway;
+    uint32_t SubnetMask;
+    uint32_t DnsPrimary;
+    uint32_t DnsSecondary;
+    uint32_t Mtu;
+} IPV4_T;
+
+typedef struct __IPV6 {
+    UCHAR Address[16];
+    UCHAR Gateway[16];
+    UCHAR SubnetMask[16];
+    UCHAR DnsPrimary[16];
+    UCHAR DnsSecondary[16];
+    UCHAR PrefixLengthIPAddr;
+    UCHAR PrefixLengthGateway;
+    ULONG Mtu;
+} IPV6_T;
+
+typedef struct {
+    UINT size;
+    UINT rx_urb_size;
+    UINT ep_type;
+    UINT iface_id;
+    UINT MuxId;
+    UINT ul_data_aggregation_max_datagrams; //0x17
+    UINT ul_data_aggregation_max_size ;//0x18
+    UINT dl_minimum_padding; //0x1A
+} QMAP_SETTING;
+
+//Configured downlink data aggregationprotocol
+#define WDA_DL_DATA_AGG_DISABLED (0x00) //DL data aggregation is disabled (default)
+#define WDA_DL_DATA_AGG_TLP_ENABLED (0x01) // DL TLP is enabled
+#define WDA_DL_DATA_AGG_QC_NCM_ENABLED (0x02) // DL QC_NCM isenabled
+#define WDA_DL_DATA_AGG_MBIM_ENABLED (0x03) // DL MBIM isenabled
+#define WDA_DL_DATA_AGG_RNDIS_ENABLED (0x04) // DL RNDIS is enabled
+#define WDA_DL_DATA_AGG_QMAP_ENABLED (0x05) // DL QMAP isenabled
+#define WDA_DL_DATA_AGG_QMAP_V2_ENABLED (0x06) // DL QMAP V2 is enabled
+#define WDA_DL_DATA_AGG_QMAP_V3_ENABLED (0x07) // DL QMAP V3 is enabled
+#define WDA_DL_DATA_AGG_QMAP_V4_ENABLED (0x08) // DL QMAP V4 is enabled
+#define WDA_DL_DATA_AGG_QMAP_V5_ENABLED (0x09) // DL QMAP V5 is enabled
+
+typedef struct {
+    unsigned int size;
+    unsigned int rx_urb_size;
+    unsigned int ep_type;
+    unsigned int iface_id;
+    unsigned int qmap_mode;
+    unsigned int qmap_version;
+    unsigned int dl_minimum_padding;
+    char ifname[8][16];
+    unsigned char mux_id[8];
+} RMNET_INFO;
+
+#define IpFamilyV4 (0x04)
+#define IpFamilyV6 (0x06)
+
+struct __PROFILE;
+struct qmi_device_ops {
+	int (*init)(struct __PROFILE *profile);
+	int (*deinit)(void);
+	int (*send)(PQCQMIMSG pRequest);
+	void* (*read)(void *pData);
+
+    
+    // int (*thread_read)(struct __PROFILE *profile);
+    // int (*init)(struct __PROFILE *profile);
+    // int (*open)(struct __PROFILE *profile);
+    // int (*close)(struct __PROFILE *profile);
+    // int (*reopen)(struct __PROFILE *profile);
+    // int (*start_network)(struct __PROFILE *profile);
+    // int (*stop_network)(struct __PROFILE *profile);
+    // int (*query_network)(struct __PROFILE *profile);
+};
+extern int (*qmidev_send)(PQCQMIMSG pRequest);
+
+#ifndef bool
+#define bool uint8_t
+#endif
+typedef struct __PROFILE {
+    char *qmichannel;
+    char *usbnet_adapter;
+    char *qmapnet_adapter;
+    char *driver_name;
+    int qmap_mode;
+    int qmap_size;
+    int qmap_version;
+    const char *apn;
+    const char *user;
+    const char *password;
+    const char *pincode;
+    int auth;
+    int pdp;
+    int curIpFamily;
+    int rawIP;
+    int muxid;
+    int enable_bridge;
+    IPV4_T ipv4;
+    IPV6_T ipv6;
+    UINT PCSCFIpv4Addr1;
+    UINT PCSCFIpv4Addr2;
+    UCHAR PCSCFIpv6Addr1[16];
+    UCHAR PCSCFIpv6Addr2[16];
+    bool enable_ipv4;
+    bool enable_ipv6;
+    int  apntype;
+    bool reattach_flag;
+    int hardware_interface;
+    int software_interface;
+    int busnum;
+    int devnum;
+    int usbmon_fd;
+    int usbmon_logfile_fd;
+    bool loopback_state;
+    int replication_factor;
+    const struct qmi_device_ops *qmi_ops;
+    RMNET_INFO rmnet_info;
+} PROFILE_T;
+
+typedef enum {
+    SIM_ABSENT = 0,
+    SIM_NOT_READY = 1,
+    SIM_READY = 2, /* SIM_READY means the radio state is RADIO_STATE_SIM_READY */
+    SIM_PIN = 3,
+    SIM_PUK = 4,
+    SIM_NETWORK_PERSONALIZATION = 5,
+    SIM_BAD = 6,
+} SIM_Status;
+
+#pragma pack(pop)
+
+#define WDM_DEFAULT_BUFSIZE	256
+#define RIL_REQUEST_QUIT    0x1000
+#define RIL_INDICATE_DEVICE_CONNECTED    0x1002
+#define RIL_INDICATE_DEVICE_DISCONNECTED    0x1003
+#define RIL_UNSOL_RESPONSE_VOICE_NETWORK_STATE_CHANGED    0x1004
+#define RIL_UNSOL_DATA_CALL_LIST_CHANGED    0x1005
+#define MODEM_REPORT_RESET_EVENT 0x1006
+#define RIL_UNSOL_LOOPBACK_CONFIG_IND 0x1007
+
+extern int pthread_cond_timeout_np(pthread_cond_t *cond, pthread_mutex_t * mutex, unsigned msecs);
+extern int QmiThreadSendQMI(PQCQMIMSG pRequest, PQCQMIMSG *ppResponse);
+extern int QmiThreadSendQMITimeout(PQCQMIMSG pRequest, PQCQMIMSG *ppResponse, unsigned msecs);
+extern void QmiThreadRecvQMI(PQCQMIMSG pResponse);
+extern void udhcpc_start(PROFILE_T *profile);
+extern void udhcpc_stop(PROFILE_T *profile);
+extern void ql_set_driver_link_state(PROFILE_T *profile, int link_state);
+extern void ql_set_driver_qmap_setting(PROFILE_T *profile, QMAP_SETTING *qmap_settings);
+extern void ql_get_driver_rmnet_info(PROFILE_T *profile, RMNET_INFO *rmnet_info);
+extern void dump_qmi(void *dataBuffer, int dataLen);
+extern void qmidevice_send_event_to_main(int triger_event);
+extern void qmidevice_send_event_to_main_ext(int triger_event, void *data, unsigned len);
+extern int requestSetEthMode(PROFILE_T *profile);
+extern int requestGetSIMStatus(SIM_Status *pSIMStatus);
+extern int requestEnterSimPin(const CHAR *pPinCode);
+extern int requestGetICCID(void);
+extern int requestGetIMSI(void);
+extern int requestRegistrationState(UCHAR *pPSAttachedState);
+extern int requestQueryDataCall(UCHAR  *pConnectionStatus, int curIpFamily);
+extern int requestSetupDataCall(PROFILE_T *profile, int curIpFamily);
+extern int requestDeactivateDefaultPDP(PROFILE_T *profile, int curIpFamily);
+extern int requestSetProfile(PROFILE_T *profile);
+extern int requestGetProfile(PROFILE_T *profile);
+extern int requestGetSignalInfo(void);
+extern int requestBaseBandVersion(const char **pp_reversion);
+extern int requestGetIPAddress(PROFILE_T *profile, int curIpFamily);
+extern int requestSetOperatingMode(UCHAR OperatingMode);
+extern int requestSetLoopBackState(UCHAR loopback_state, ULONG replication_factor);
+
+extern void cond_setclock_attr(pthread_cond_t *cond, clockid_t clock);
+extern int mbim_main(PROFILE_T *profile);
+extern int get_driver_type(PROFILE_T *profile);
+extern BOOL qmidevice_detect(char *qmichannel, char *usbnet_adapter, unsigned bufsize, int *pbusnum, int *pdevnum);
+int mhidevice_detect(char *qmichannel, char *usbnet_adapter, PROFILE_T *profile);
+extern int ql_bridge_mode_detect(PROFILE_T *profile);
+extern int ql_enable_qmi_wwan_rawip_mode(PROFILE_T *profile);
+extern int ql_driver_type_detect(PROFILE_T *profile);
+extern int ql_qmap_mode_detect(PROFILE_T *profile);
+extern const struct qmi_device_ops gobi_qmidev_ops;
+extern const struct qmi_device_ops qmiwwan_qmidev_ops;
+
+#define qmidev_is_gobinet(_qmichannel) (strncmp(_qmichannel, "/dev/qcqmi", strlen("/dev/qcqmi")) == 0)
+#define qmidev_is_qmiwwan(_qmichannel) (strncmp(_qmichannel, "/dev/cdc-wdm", strlen("/dev/cdc-wdm")) == 0)
+#define qmidev_is_pciemhi(_qmichannel) (strncmp(_qmichannel, "/dev/mhi_", strlen("/dev/mhi_")) == 0)
+
+#define driver_is_qmi(_drv_name) (strncasecmp(_drv_name, "qmi_wwan", strlen("qmi_wwan")) == 0)
+#define driver_is_mbim(_drv_name) (strncasecmp(_drv_name, "cdc_mbim", strlen("cdc_mbim")) == 0)
+
+extern FILE *logfilefp;
+extern int debug_qmi;
+extern int qmidevice_control_fd[2];
+extern int qmiclientId[QMUX_TYPE_WDS_ADMIN + 1];
+extern USHORT le16_to_cpu(USHORT v16);
+extern UINT  le32_to_cpu (UINT v32);
+extern UINT  ql_swap32(UINT v32);
+extern USHORT cpu_to_le16(USHORT v16);
+extern UINT cpu_to_le32(UINT v32);
+extern void update_resolv_conf(int iptype, const char *ifname, const char *dns1, const char *dns2);
+int reattach_driver(PROFILE_T *profile);
+
+enum
+{
+	DRV_INVALID,
+	SOFTWARE_QMI,
+	SOFTWARE_MBIM,
+	HARDWARE_PCIE,
+	HARDWARE_USB,
+};
+
+enum
+{
+    SIG_EVENT_START,
+    SIG_EVENT_CHECK,
+    SIG_EVENT_STOP,
+};
+
+#define CM_MAX_BUFF 256
+#define strset(k, v) {if (k) free(k); k = strdup(v);}
+#define mfree(v) {if (v) {free(v); v = NULL;}
+
+#ifdef CM_DEBUG
+#define dbg_time(fmt, args...) do { \
+    fprintf(stdout, "[%15s-%04d: %s] " fmt "\n", __FILE__, __LINE__, get_time(), ##args); \
+    if (logfilefp) fprintf(logfilefp, "[%s-%04d: %s] " fmt "\n", __FILE__, __LINE__, get_time(), ##args); \
+} while(0)
+#else
+#define dbg_time(fmt, args...) do { \
+    fprintf(stdout, "[%s] " fmt "\n", get_time(), ##args); \
+    if (logfilefp) fprintf(logfilefp, "[%s] " fmt "\n", get_time(), ##args); \
+} while(0)
+#endif
+#endif

root/package/link4all/quectel-CM/quectel1.6.0.15_src/QmiWwanCM.c

@@ -0,0 +1,389 @@
+/******************************************************************************
+  @file    QmiWwanCM.c
+  @brief   QMI WWAN connectivity manager.
+
+  DESCRIPTION
+  Connectivity Management Tool for USB network adapter of Quectel wireless cellular modules.
+
+  INITIALIZATION AND SEQUENCING REQUIREMENTS
+  None.
+
+  ---------------------------------------------------------------------------
+  Copyright (c) 2016 - 2020 Quectel Wireless Solution, Co., Ltd.  All Rights Reserved.
+  Quectel Wireless Solution Proprietary and Confidential.
+  ---------------------------------------------------------------------------
+******************************************************************************/
+
+#include <stdio.h>
+#include <string.h>
+#include <termios.h>
+#include <stdio.h>
+#include <ctype.h>
+typedef unsigned short sa_family_t;
+#include <linux/un.h>
+#include "QMIThread.h"
+
+#ifdef CONFIG_QMIWWAN
+static int cdc_wdm_fd = -1;
+static UCHAR GetQCTLTransactionId(void) {
+    static int TransactionId = 0;
+    if (++TransactionId > 0xFF)
+        TransactionId = 1;
+    return TransactionId;
+}
+
+typedef USHORT (*CUSTOMQCTL)(PQMICTL_MSG pCTLMsg, void *arg);
+
+static PQCQMIMSG ComposeQCTLMsg(USHORT QMICTLType, CUSTOMQCTL customQctlMsgFunction, void *arg) {
+    UCHAR QMIBuf[WDM_DEFAULT_BUFSIZE];
+    PQCQMIMSG pRequest = (PQCQMIMSG)QMIBuf;
+    int Length;
+
+    pRequest->QMIHdr.IFType   = USB_CTL_MSG_TYPE_QMI;
+    pRequest->QMIHdr.CtlFlags = 0x00;
+    pRequest->QMIHdr.QMIType  = QMUX_TYPE_CTL;
+    pRequest->QMIHdr.ClientId= 0x00;
+
+    pRequest->CTLMsg.QMICTLMsgHdr.CtlFlags = QMICTL_FLAG_REQUEST;
+    pRequest->CTLMsg.QMICTLMsgHdr.TransactionId = GetQCTLTransactionId();
+    pRequest->CTLMsg.QMICTLMsgHdr.QMICTLType = cpu_to_le16(QMICTLType);
+    if (customQctlMsgFunction)
+        pRequest->CTLMsg.QMICTLMsgHdr.Length = cpu_to_le16(customQctlMsgFunction(&pRequest->CTLMsg, arg) - sizeof(QCQMICTL_MSG_HDR));
+    else
+        pRequest->CTLMsg.QMICTLMsgHdr.Length = cpu_to_le16(0x0000);
+
+    pRequest->QMIHdr.Length = cpu_to_le16(le16_to_cpu(pRequest->CTLMsg.QMICTLMsgHdr.Length) + sizeof(QCQMICTL_MSG_HDR) + sizeof(QCQMI_HDR) - 1);
+    Length = le16_to_cpu(pRequest->QMIHdr.Length) + 1;
+
+    pRequest = (PQCQMIMSG)malloc(Length);
+    if (pRequest == NULL) {
+        dbg_time("%s fail to malloc", __func__);
+    } else {
+        memcpy(pRequest, QMIBuf, Length);
+    }
+
+    return pRequest;
+}
+
+static USHORT CtlGetVersionReq(PQMICTL_MSG QCTLMsg, void *arg) {
+   QCTLMsg->GetVersionReq.TLVType       = QCTLV_TYPE_REQUIRED_PARAMETER;
+   QCTLMsg->GetVersionReq.TLVLength     = cpu_to_le16(0x0001);
+   QCTLMsg->GetVersionReq.QMUXTypes     = QMUX_TYPE_ALL;
+   return sizeof(QMICTL_GET_VERSION_REQ_MSG);
+}
+
+static USHORT CtlGetClientIdReq(PQMICTL_MSG QCTLMsg, void *arg) {
+   QCTLMsg->GetClientIdReq.TLVType       = QCTLV_TYPE_REQUIRED_PARAMETER;
+   QCTLMsg->GetClientIdReq.TLVLength     = cpu_to_le16(0x0001);
+   QCTLMsg->GetClientIdReq.QMIType     = ((UCHAR *)arg)[0];
+   return sizeof(QMICTL_GET_CLIENT_ID_REQ_MSG);
+}
+
+static USHORT CtlReleaseClientIdReq(PQMICTL_MSG QCTLMsg, void *arg) {
+   QCTLMsg->ReleaseClientIdReq.TLVType       = QCTLV_TYPE_REQUIRED_PARAMETER;
+   QCTLMsg->ReleaseClientIdReq.TLVLength     = cpu_to_le16(0x0002);
+   QCTLMsg->ReleaseClientIdReq.QMIType     = ((UCHAR *)arg)[0];
+   QCTLMsg->ReleaseClientIdReq.ClientId = ((UCHAR *)arg)[1] ;
+   return sizeof(QMICTL_RELEASE_CLIENT_ID_REQ_MSG);
+}
+
+static int QmiWwanSendQMI(PQCQMIMSG pRequest) {
+    struct pollfd pollfds[]= {{cdc_wdm_fd, POLLOUT, 0}};
+    int ret;
+
+    if (cdc_wdm_fd == -1) {
+        dbg_time("%s cdc_wdm_fd = -1", __func__);
+        return -ENODEV;
+    }
+
+    if (pRequest->QMIHdr.QMIType == QMUX_TYPE_WDS_IPV6)
+        pRequest->QMIHdr.QMIType = QMUX_TYPE_WDS;
+
+    do {
+        ret = poll(pollfds, sizeof(pollfds)/sizeof(pollfds[0]), 5000);
+    } while ((ret < 0) && (errno == EINTR));
+
+    if (pollfds[0].revents & POLLOUT) {
+        ssize_t nwrites = le16_to_cpu(pRequest->QMIHdr.Length) + 1;
+        ret = write(cdc_wdm_fd, pRequest, nwrites);
+        if (ret == nwrites) {
+            ret = 0;
+        } else {
+            dbg_time("%s write=%d, errno: %d (%s)", __func__, ret, errno, strerror(errno));
+        }
+    } else {
+        dbg_time("%s poll=%d, revents = 0x%x, errno: %d (%s)", __func__, ret, pollfds[0].revents, errno, strerror(errno));
+    }
+
+    return ret;
+}
+
+static int QmiWwanGetClientID(UCHAR QMIType) {
+    PQCQMIMSG pResponse;
+
+    QmiThreadSendQMI(ComposeQCTLMsg(QMICTL_GET_CLIENT_ID_REQ, CtlGetClientIdReq, &QMIType), &pResponse);
+
+    if (pResponse) {
+        USHORT QMUXResult = cpu_to_le16(pResponse->CTLMsg.QMICTLMsgHdrRsp.QMUXResult);       // QMI_RESULT_SUCCESS
+        USHORT QMUXError = cpu_to_le16(pResponse->CTLMsg.QMICTLMsgHdrRsp.QMUXError);        // QMI_ERR_INVALID_ARG
+        //UCHAR QMIType = pResponse->CTLMsg.GetClientIdRsp.QMIType;
+        UCHAR ClientId = pResponse->CTLMsg.GetClientIdRsp.ClientId;
+
+        if (!QMUXResult && !QMUXError && (QMIType == pResponse->CTLMsg.GetClientIdRsp.QMIType)) {
+            switch (QMIType) {
+                case QMUX_TYPE_WDS: dbg_time("Get clientWDS = %d", ClientId); break;
+                case QMUX_TYPE_DMS: dbg_time("Get clientDMS = %d", ClientId); break;
+                case QMUX_TYPE_NAS: dbg_time("Get clientNAS = %d", ClientId); break;
+                case QMUX_TYPE_QOS: dbg_time("Get clientQOS = %d", ClientId); break;
+                case QMUX_TYPE_WMS: dbg_time("Get clientWMS = %d", ClientId); break;
+                case QMUX_TYPE_PDS: dbg_time("Get clientPDS = %d", ClientId); break;
+                case QMUX_TYPE_UIM: dbg_time("Get clientUIM = %d", ClientId); break;
+                case QMUX_TYPE_WDS_ADMIN: dbg_time("Get clientWDA = %d", ClientId);
+                break;
+                default: break;
+            }
+            return ClientId;
+        }
+    }
+    return 0;
+}
+
+static int QmiWwanReleaseClientID(QMI_SERVICE_TYPE QMIType, UCHAR ClientId) {
+    UCHAR argv[] = {QMIType, ClientId};
+    QmiThreadSendQMI(ComposeQCTLMsg(QMICTL_RELEASE_CLIENT_ID_REQ, CtlReleaseClientIdReq, argv), NULL);
+    return 0;
+}
+
+static int QmiWwanInit(PROFILE_T *profile) {
+    unsigned i;
+    int ret;
+    PQCQMIMSG pResponse;
+
+    if (profile->qmap_mode == 0 || profile->qmap_mode == 1)
+    {
+        for (i = 0; i < 10; i++) {
+            ret = QmiThreadSendQMITimeout(ComposeQCTLMsg(QMICTL_SYNC_REQ, NULL, NULL), NULL, 1 * 1000);
+            if (!ret)
+                break;
+            sleep(1);
+        }
+        if (ret)
+            return ret;
+    }
+
+    QmiThreadSendQMI(ComposeQCTLMsg(QMICTL_GET_VERSION_REQ, CtlGetVersionReq, NULL), &pResponse);
+    if (profile->qmap_mode) {
+        if (pResponse) {
+            if (pResponse->CTLMsg.QMICTLMsgHdrRsp.QMUXResult == 0 && pResponse->CTLMsg.QMICTLMsgHdrRsp.QMUXError == 0) {
+                uint8_t  NumElements = 0;
+
+                for (NumElements = 0; NumElements < pResponse->CTLMsg.GetVersionRsp.NumElements; NumElements++) {
+#if 0
+                    dbg_time("QMUXType = %02x Version = %d.%d",
+                        pResponse->CTLMsg.GetVersionRsp.TypeVersion[NumElements].QMUXType,
+                        pResponse->CTLMsg.GetVersionRsp.TypeVersion[NumElements].MajorVersion,
+                        pResponse->CTLMsg.GetVersionRsp.TypeVersion[NumElements].MinorVersion);
+#endif
+                    if (pResponse->CTLMsg.GetVersionRsp.TypeVersion[NumElements].QMUXType == QMUX_TYPE_WDS_ADMIN)
+                        profile->qmap_version = (pResponse->CTLMsg.GetVersionRsp.TypeVersion[NumElements].MinorVersion > 16);
+                }
+            }
+        }
+    }
+    if (pResponse) free(pResponse);
+    qmiclientId[QMUX_TYPE_WDS] = QmiWwanGetClientID(QMUX_TYPE_WDS);
+    if (profile->enable_ipv6)
+        qmiclientId[QMUX_TYPE_WDS_IPV6] = QmiWwanGetClientID(QMUX_TYPE_WDS);
+    qmiclientId[QMUX_TYPE_DMS] = QmiWwanGetClientID(QMUX_TYPE_DMS);
+    qmiclientId[QMUX_TYPE_NAS] = QmiWwanGetClientID(QMUX_TYPE_NAS);
+    qmiclientId[QMUX_TYPE_UIM] = QmiWwanGetClientID(QMUX_TYPE_UIM);
+    if (profile->qmap_mode == 0 || profile->qmap_mode == 1)
+        qmiclientId[QMUX_TYPE_WDS_ADMIN] = QmiWwanGetClientID(QMUX_TYPE_WDS_ADMIN);
+
+    return 0;
+}
+
+static int QmiWwanDeInit(void) {
+    unsigned int i;
+    for (i = 0; i < sizeof(qmiclientId)/sizeof(qmiclientId[0]); i++)
+    {
+        if (qmiclientId[i] != 0)
+        {
+                QmiWwanReleaseClientID(i, qmiclientId[i]);
+                qmiclientId[i] = 0;
+        }
+    }
+
+    return 0;
+}
+
+#define QUECTEL_QMI_PROXY "quectel-qmi-proxy"
+static int qmi_proxy_open(const char *name) {
+    int sockfd = -1;
+    int reuse_addr = 1;
+    struct sockaddr_un sockaddr;
+    socklen_t alen;
+
+    /*Create server socket*/
+    (sockfd = socket(AF_LOCAL, SOCK_STREAM, 0));
+    if (sockfd < 0)
+        return sockfd;
+
+    memset(&sockaddr, 0, sizeof(sockaddr));
+    sockaddr.sun_family = AF_LOCAL;
+    sockaddr.sun_path[0] = 0;
+    memcpy(sockaddr.sun_path + 1, name, strlen(name) );
+
+    alen = strlen(name) + offsetof(struct sockaddr_un, sun_path) + 1;
+    if(connect(sockfd, (struct sockaddr *)&sockaddr, alen) < 0) {
+        close(sockfd);
+        dbg_time("%s connect %s errno: %d (%s)\n", __func__, name, errno, strerror(errno));
+        return -1;
+    }
+    (setsockopt(sockfd, SOL_SOCKET, SO_REUSEADDR, &reuse_addr,sizeof(reuse_addr)));
+
+    dbg_time("connect to %s sockfd = %d\n", name, sockfd);
+
+    return sockfd;
+}
+
+static ssize_t qmi_proxy_read (int fd, void *buf, size_t size) {
+    ssize_t nreads;
+    PQCQMI_HDR pHdr = (PQCQMI_HDR)buf;
+
+    nreads = read(fd, pHdr, sizeof(QCQMI_HDR));
+    if (nreads == sizeof(QCQMI_HDR)) {
+        nreads += read(fd, pHdr+1, le16_to_cpu(pHdr->Length) + 1 - sizeof(QCQMI_HDR));
+    }
+
+    return nreads;
+}
+
+static void * QmiWwanThread(void *pData) {
+    PROFILE_T *profile = (PROFILE_T *)pData;
+    const char *cdc_wdm = (const char *)profile->qmichannel;
+    int wait_for_request_quit = 0;
+    char servername[32];
+    int num = cdc_wdm[strlen(cdc_wdm)-1]-'0';
+	
+    sprintf(servername, QUECTEL_QMI_PROXY"%d", num);
+    
+    if (profile->qmap_mode == 0 || profile->qmap_mode == 1)
+        cdc_wdm_fd = open(cdc_wdm, O_RDWR | O_NONBLOCK | O_NOCTTY);
+    else
+        cdc_wdm_fd = qmi_proxy_open(servername);
+
+    if (cdc_wdm_fd == -1) {
+        dbg_time("%s Failed to open %s, errno: %d (%s)", __func__, cdc_wdm, errno, strerror(errno));
+        qmidevice_send_event_to_main(RIL_INDICATE_DEVICE_DISCONNECTED);
+        pthread_exit(NULL);
+        return NULL;
+    }
+
+    fcntl(cdc_wdm_fd, F_SETFL, fcntl(cdc_wdm_fd,F_GETFL) | O_NONBLOCK);
+    fcntl(cdc_wdm_fd, F_SETFD, FD_CLOEXEC);
+
+    dbg_time("cdc_wdm_fd = %d", cdc_wdm_fd);
+
+    qmidevice_send_event_to_main(RIL_INDICATE_DEVICE_CONNECTED);
+    while (1) {
+        struct pollfd pollfds[] = {{qmidevice_control_fd[1], POLLIN, 0}, {cdc_wdm_fd, POLLIN, 0}};
+        int ne, ret, nevents = sizeof(pollfds)/sizeof(pollfds[0]);
+
+        do {
+            ret = poll(pollfds, nevents, wait_for_request_quit ? 1000 : -1);
+         } while ((ret < 0) && (errno == EINTR));
+
+	if (ret == 0 && wait_for_request_quit) {
+            QmiThreadRecvQMI(NULL);
+            continue;
+	}
+
+        if (ret <= 0) {
+            dbg_time("%s poll=%d, errno: %d (%s)", __func__, ret, errno, strerror(errno));
+            break;
+        }
+
+        for (ne = 0; ne < nevents; ne++) {
+            int fd = pollfds[ne].fd;
+            short revents = pollfds[ne].revents;
+
+            //dbg_time("{%d, %x, %x}", pollfds[ne].fd, pollfds[ne].events, pollfds[ne].revents);
+
+            if (revents & (POLLERR | POLLHUP | POLLNVAL)) {
+                dbg_time("%s poll err/hup/inval", __func__);
+                dbg_time("poll fd = %d, events = 0x%04x", fd, revents);
+                if (fd == cdc_wdm_fd) {
+                } else {
+                }
+                if (revents & (POLLHUP | POLLNVAL)) //EC20 bug, Can get POLLERR
+                    goto __QmiWwanThread_quit;
+            }
+
+            if ((revents & POLLIN) == 0)
+                continue;
+
+            if (fd == qmidevice_control_fd[1]) {
+                int triger_event;
+                if (read(fd, &triger_event, sizeof(triger_event)) == sizeof(triger_event)) {
+                    //DBG("triger_event = 0x%x", triger_event);
+                    switch (triger_event) {
+                        case RIL_REQUEST_QUIT:
+                            goto __QmiWwanThread_quit;
+                        break;
+                        case SIG_EVENT_STOP:
+                            wait_for_request_quit = 1;
+                        break;
+                        default:
+                        break;
+                    }
+                }
+            }
+
+            if (fd == cdc_wdm_fd) {
+                ssize_t nreads;
+                static UCHAR QMIBuf[4096];
+                PQCQMIMSG pResponse = (PQCQMIMSG)QMIBuf;
+                
+                if (profile->qmap_mode == 0 || profile->qmap_mode == 1)
+                    nreads = read(fd, QMIBuf, sizeof(QMIBuf));
+                else
+                    nreads = qmi_proxy_read(fd, QMIBuf, sizeof(QMIBuf));
+                //dbg_time("%s read=%d errno: %d (%s)",  __func__, (int)nreads, errno, strerror(errno));
+                if (nreads <= 0) {
+                    dbg_time("%s read=%d errno: %d (%s)",  __func__, (int)nreads, errno, strerror(errno));
+                    break;
+                }
+
+                if (nreads != (le16_to_cpu(pResponse->QMIHdr.Length) + 1)) {
+                    dbg_time("%s nreads=%d,  pQCQMI->QMIHdr.Length = %d",  __func__, (int)nreads, le16_to_cpu(pResponse->QMIHdr.Length));
+                    continue;
+                }
+
+                QmiThreadRecvQMI(pResponse);
+            }
+        }
+    }
+
+__QmiWwanThread_quit:
+    if (cdc_wdm_fd != -1) { close(cdc_wdm_fd); cdc_wdm_fd = -1; }
+    qmidevice_send_event_to_main(RIL_INDICATE_DEVICE_DISCONNECTED);
+    QmiThreadRecvQMI(NULL); //main thread may pending on QmiThreadSendQMI()
+    dbg_time("%s exit", __func__);
+    pthread_exit(NULL);
+    return NULL;
+}
+
+#else
+static int QmiWwanSendQMI(PQCQMIMSG pRequest) {return -1;}
+static int QmiWwanInit(PROFILE_T *profile) {return -1;}
+static int QmiWwanDeInit(void) {return -1;}
+static void * QmiWwanThread(void *pData) {dbg_time("please set CONFIG_QMIWWAN"); return NULL;}
+#endif
+
+const struct qmi_device_ops qmiwwan_qmidev_ops = {
+    .init = QmiWwanInit,
+    .deinit = QmiWwanDeInit,
+    .send = QmiWwanSendQMI,
+    .read = QmiWwanThread,
+};

root/package/link4all/quectel-CM/quectel1.6.0.15_src/ReleaseNote.txt

@@ -0,0 +1,69 @@
+Release Notes
+
+[WCDMA&LTE_QConnectManager_Linux&Android_V1.5.3]
+Date:   2019/12/11
+enhancement:
+1. support show SignalInfo, controlled by macro CONFIG_SIGNALINFO
+2. support show 5G_NSA/5G_NA
+3. support Microsoft Extend MBIM message
+
+[WCDMA&LTE_QConnectManager_Linux&Android_V1.2.1]
+Date:   2019/02/26
+enhancement:
+1. Implement help message.
+
+root@ubuntu:# ./quectel-CM -h
+[02-26_10:39:21:353] Usage: ./quectel-CM [options]
+[02-26_10:39:21:353] -s [apn [user password auth]]          Set apn/user/password/auth get from your network provider
+[02-26_10:39:21:353] -p pincode                             Verify sim card pin if sim card is locked
+[02-26_10:39:21:353] -f logfilename                         Save log message of this program to file
+[02-26_10:39:21:353] -i interface                           Specify network interface(default auto-detect)
+[02-26_10:39:21:353] -4                                     IPv4 protocol
+[02-26_10:39:21:353] -6                                     IPv6 protocol
+[02-26_10:39:21:353] -m muxID                               Specify muxid when set multi-pdn data connection.
+[02-26_10:39:21:353] -n channelID                           Specify channelID when set multi-pdn data connection(default 1).
+[02-26_10:39:21:353] [Examples]
+[02-26_10:39:21:353] Example 1: ./quectel-CM
+[02-26_10:39:21:353] Example 2: ./quectel-CM -s 3gnet
+[02-26_10:39:21:353] Example 3: ./quectel-CM -s 3gnet carl 1234 0 -p 1234 -f gobinet_log.txt
+root@ubuntu:#
+2. Support bridge mode when set multi-pdn data connections.
+3. Host device can access network in bridge mode.
+
+[WCDMA&LTE_QConnectManager_Linux&Android_V1.1.46]
+Date:   2019/02/18
+enhancement:
+1. support only IPV6 data call. quectel-CM now support three dialing methods: IPV4 only, IPV6 only, IPV4V6.
+	./quectel-CM  -4(or no argument)  only IPV4
+				  -6	        only IPV6
+				  -4 -6               IPV4 && IPV6
+
+[WCDMA&LTE_QConnectManager_Linux&Android_V1.1.45]
+Date:   2018/09/13
+enhancement:
+1. support EG12 PCIE interface
+
+[WCDMA&LTE_QConnectManager_Linux&Android_V1.1.44]
+Date:   2018/09/10
+enhancement:
+1. support setup IPV4&IPV6 data call.
+
+[WCDMA&LTE_QConnectManager_Linux&Android_V1.1.43]
+[WCDMA&LTE_QConnectManager_Linux&Android_V1.1.42]
+Date:   2018/08/29
+enhancement:
+1. support QMI_WWAN's QMAP fucntion and bridge mode, please contact Quectel FAE to get qmi_wwan.c patch.
+   when enable QMI_WWAN's QMAP IP Mux function, must run 'quectel-qmi-proxy -d /dev/cdc-wdmX' before quectel-CM
+
+[WCDMA&LTE_QConnectManager_Linux&Android_V1.1.41]
+Date:   2018/05/24
+enhancement:
+1. fix a cdma data call error
+
+[WCDMA&LTE_QConnectManager_Linux&Android_V1.1.40]
+Date:   2018/05/12
+enhancement:
+1. support GobiNet's QMAP fucntion and bridge mode.
+	 'Quectel_WCDMA&LTE_Linux&Android_GobiNet_Driver_V1.3.5' and later version is required to use QMAP and bridge mode.
+	 for detail, please refer to GobiNet Driver
+	 

root/package/link4all/quectel-CM/quectel1.6.0.15_src/default.script

@@ -0,0 +1,63 @@
+#!/bin/sh
+# Busybox udhcpc dispatcher script. Copyright (C) 2009 by Axel Beckert.
+#
+# Based on the busybox example scripts and the old udhcp source
+# package default.* scripts.
+
+RESOLV_CONF="/etc/resolv.conf"
+
+case $1 in
+    bound|renew)
+	[ -n "$broadcast" ] && BROADCAST="broadcast $broadcast"
+	[ -n "$subnet" ] && NETMASK="netmask $subnet"
+
+	/sbin/ifconfig $interface $ip $BROADCAST $NETMASK
+
+	if [ -n "$router" ]; then
+	    echo "$0: Resetting default routes"
+	    while /sbin/route del default gw 0.0.0.0 dev $interface; do :; done
+
+	    metric=0
+	    for i in $router; do
+		/sbin/route add default gw $i dev $interface metric $metric
+		metric=$(($metric + 1))
+	    done
+	fi
+
+	# Update resolver configuration file
+	R=""
+	[ -n "$domain" ] && R="domain $domain
+"
+	for i in $dns; do
+	    echo "$0: Adding DNS $i"
+	    R="${R}nameserver $i
+"
+	done
+
+	if [ -x /sbin/resolvconf ]; then
+	    echo -n "$R" | resolvconf -a "${interface}.udhcpc"
+	else
+	    echo -n "$R" > "$RESOLV_CONF"
+	fi
+	;;
+
+    deconfig)
+	if [ -x /sbin/resolvconf ]; then
+	    resolvconf -d "${interface}.udhcpc"
+	fi
+	/sbin/ifconfig $interface 0.0.0.0
+	;;
+
+    leasefail)
+	echo "$0: Lease failed: $message"
+	;;
+
+    nak)
+	echo "$0: Received a NAK: $message"
+	;;
+
+    *)
+	echo "$0: Unknown udhcpc command: $1";
+	exit 1;
+	;;
+esac

root/package/link4all/quectel-CM/quectel1.6.0.15_src/device.c

@@ -0,0 +1,500 @@
+/******************************************************************************
+  @file    device.c
+  @brief   QMI device dirver.
+
+  DESCRIPTION
+  Connectivity Management Tool for USB network adapter of Quectel wireless cellular modules.
+
+  INITIALIZATION AND SEQUENCING REQUIREMENTS
+  None.
+
+  ---------------------------------------------------------------------------
+  Copyright (c) 2016 - 2020 Quectel Wireless Solution, Co., Ltd.  All Rights Reserved.
+  Quectel Wireless Solution Proprietary and Confidential.
+  ---------------------------------------------------------------------------
+******************************************************************************/
+#include <unistd.h>
+#include <sys/types.h>
+#include <fcntl.h>
+#include <dirent.h>
+#include <errno.h>
+#include <strings.h>
+#include <stdlib.h>
+#include <limits.h>
+#include <linux/usbdevice_fs.h>
+#include <linux/types.h>
+#include <sys/ioctl.h>
+#include <sys/socket.h>
+#include <net/if.h>
+#include <time.h>
+#include <pthread.h>
+
+#include "QMIThread.h"
+#include "ethtool-copy.h"
+
+#define CM_MAX_PATHLEN 256
+
+#define CM_INVALID_VAL (~((int)0))
+/* get first line from file 'fname'
+ * And convert the content into a hex number, then return this number */
+static int file_get_value(const char *fname, int base)
+{
+    FILE *fp = NULL;
+    int num;
+    char buff[32 + 1] = {'\0'};
+    char *endptr = NULL;
+
+    fp = fopen(fname, "r");
+    if (!fp) goto error;
+    if (fgets(buff, sizeof(buff), fp) == NULL)
+        goto error;
+    fclose(fp);
+
+    num = (int)strtol(buff, &endptr, base);
+    if (errno == ERANGE && (num == LONG_MAX || num == LONG_MIN))
+        goto error;
+    /* if there is no digit in buff */
+    if (endptr == buff)
+        goto error;
+    return num;
+
+error:
+    if (fp) fclose(fp);
+    return CM_INVALID_VAL;
+}
+
+/*
+ * This function will search the directory 'dirname' and return the first child.
+ * '.' and '..' is ignored by default
+ */
+int dir_get_child(const char *dirname, char *buff, unsigned bufsize)
+{
+    struct dirent *entptr = NULL;
+    DIR *dirptr = opendir(dirname);
+    if (!dirptr)
+        goto error;
+    while ((entptr = readdir(dirptr))) {
+        if (entptr->d_name[0] == '.')
+            continue;
+        snprintf(buff, bufsize, "%s", entptr->d_name);
+        break;
+    }
+
+    closedir(dirptr);
+    return 0;
+error:
+    buff[0] = '\0';
+    if (dirptr) closedir(dirptr);
+    return -1;
+}
+
+int conf_get_val(const char *fname, const char *key)
+{
+    char buff[CM_MAX_BUFF] = {'\0'};
+    FILE *fp = fopen(fname, "r");
+    if (!fp)
+        goto error;
+    
+    while (fgets(buff, CM_MAX_BUFF, fp)) {
+        char prefix[CM_MAX_BUFF] = {'\0'};
+        char tail[CM_MAX_BUFF] = {'\0'};
+        /* To eliminate cppcheck warnning: Assume string length is no more than 15 */
+        sscanf(buff, "%15[^=]=%15s", prefix, tail);
+        if (!strncasecmp(prefix, key, strlen(key))) {
+            fclose(fp);
+            return atoi(tail);
+        }
+    }
+
+error:
+    fclose(fp);
+    return CM_INVALID_VAL;
+}
+
+static int detect_path_cdc_wdm_or_qcqmi(char *path, size_t len)
+{
+    size_t offset = strlen(path);
+
+    if (!access(path, R_OK))
+    {
+        path[offset] = '\0';
+        strcat(path, "/GobiQMI");
+        if (!access(path, R_OK))
+            return 0;
+
+        path[offset] = '\0';
+        strcat(path, "/usbmisc");
+        if (!access(path, R_OK))
+            return 0;
+
+        path[offset] = '\0';
+        strcat(path, "/usb");
+        if (!access(path, R_OK))
+            return 0;
+    }
+
+    return -1;
+}
+
+/* To detect the device info of the modem.
+ * return:
+ *  FALSE -> fail
+ *  TRUE -> ok
+ */
+BOOL qmidevice_detect(char *qmichannel, char *usbnet_adapter, unsigned bufsize, int *pbusnum, int *pdevnum) {
+    struct dirent* ent = NULL;
+    DIR *pDir;
+    const char *rootdir = "/sys/bus/usb/devices";
+    struct {
+        char path[255*2];
+        char uevent[255*3];
+    } *pl;
+    pl = (typeof(pl)) malloc(sizeof(*pl));
+    memset(pl, 0x00, sizeof(*pl));
+
+    pDir = opendir(rootdir);
+    if (!pDir) {
+        dbg_time("opendir %s failed: %s", rootdir, strerror(errno));
+        goto error;
+    }
+
+    while ((ent = readdir(pDir)) != NULL)  {
+        int idVendor;
+        int idProduct;
+        char netcard[32+1] = {'\0'};
+        char device[32+1] = {'\0'};
+        char devname[32+1+6] = {'\0'};
+        int busnum, devnum;
+
+        snprintf(pl->path, sizeof(pl->path), "%s/%s/idVendor", rootdir, ent->d_name);
+        idVendor = file_get_value(pl->path, 16);
+
+        snprintf(pl->path, sizeof(pl->path), "%s/%s/idProduct", rootdir, ent->d_name);
+        idProduct = file_get_value(pl->path, 16);
+
+        if (idVendor != 0x05c6 && idVendor != 0x2c7c)
+            continue;
+        
+        snprintf(pl->path, sizeof(pl->path), "%s/%s/busnum", rootdir, ent->d_name);
+        busnum = file_get_value(pl->path, 10);
+        snprintf(pl->path, sizeof(pl->path), "%s/%s/devnum", rootdir, ent->d_name);
+        devnum = file_get_value(pl->path, 10);
+        dbg_time("Find %s/%s idVendor=0x%x idProduct=0x%x, bus=0x%03x, dev=0x%03x", 
+            rootdir, ent->d_name, idVendor, idProduct, busnum, devnum);
+
+        /* get network interface */
+        snprintf(pl->path, sizeof(pl->path), "%s/%s:1.4/net", rootdir, ent->d_name);
+        dir_get_child(pl->path, netcard, sizeof(netcard));
+        if (netcard[0] == '\0') {
+            snprintf(pl->path, sizeof(pl->path), "%s/%s:1.8/net", rootdir, ent->d_name); //for EM12's MBIM
+            dir_get_child(pl->path, netcard, sizeof(netcard));
+        }
+
+        if (netcard[0] == '\0') { //for centos 2.6.x
+            const char *n= "usb0";
+            const char *c = "qcqmi0";
+
+            snprintf(pl->path, sizeof(pl->path), "%s/%s:1.4/net:%s", rootdir, ent->d_name, n);
+            if (!access(pl->path, F_OK)) {
+                snprintf(pl->path, sizeof(pl->path), "%s/%s:1.4/GobiQMI:%s", rootdir, ent->d_name, c);
+                if (!access(pl->path, F_OK)) {
+                    snprintf(qmichannel, bufsize, "/dev/%s", c);
+                    snprintf(usbnet_adapter, bufsize, "%s", n);
+                    break;
+                }
+            }
+        }
+
+        if (netcard[0] == '\0')
+            continue;
+
+        if (usbnet_adapter[0] && strcmp(usbnet_adapter, netcard))
+            continue;
+
+        pl->path[strlen(pl->path)-strlen("/net")] = '\0';
+        if (detect_path_cdc_wdm_or_qcqmi(pl->path, sizeof(pl->path)))
+            continue;
+
+        /* get device */
+        dir_get_child(pl->path, device, sizeof(device));
+        if (device[0] == '\0')
+            continue;
+
+        /* There is a chance that, no device(qcqmiX|cdc-wdmX) is generated. We should warn user about that! */
+        snprintf(devname, sizeof(devname), "/dev/%s", device);
+        if (access(devname, R_OK | F_OK) && errno == ENOENT) {
+            int major;
+            int minor;
+            int ret;
+
+            dbg_time("%s access failed, errno: %d (%s)", devname, errno, strerror(errno));
+            snprintf(pl->uevent, sizeof(pl->uevent), "%s/%s/uevent", pl->path, device);
+            major = conf_get_val(pl->uevent, "MAJOR");
+            minor = conf_get_val(pl->uevent, "MINOR");
+            if(major == CM_INVALID_VAL || minor == CM_INVALID_VAL)
+                dbg_time("get major and minor failed");
+
+            ret = mknod(devname, S_IFCHR|0666, (((major & 0xfff) << 8) | (minor & 0xff) | ((minor & 0xfff00) << 12)));
+            if (ret)
+                dbg_time("please mknod %s c %d %d", devname, major, minor);
+        }
+
+        if (netcard[0] && device[0]) {
+            snprintf(qmichannel, bufsize, "/dev/%s", device);
+            snprintf(usbnet_adapter, bufsize, "%s", netcard);
+            dbg_time("Auto find qmichannel = %s", qmichannel);
+            dbg_time("Auto find usbnet_adapter = %s", usbnet_adapter);
+            *pbusnum = busnum;
+            *pdevnum = devnum;
+            break;
+        }
+    }
+    closedir(pDir);
+    
+    if (qmichannel[0] == '\0' || usbnet_adapter[0] == '\0') {
+        dbg_time("network interface '%s' or qmidev '%s' is not exist", usbnet_adapter, qmichannel);
+        goto error;
+    }
+    free(pl);
+    return TRUE;
+error:
+    free(pl);
+    return FALSE;
+}
+
+int mhidevice_detect(char *qmichannel, char *usbnet_adapter, PROFILE_T *profile) {
+    if (!access("/sys/class/net/pcie_mhi0", F_OK))
+        strcpy(usbnet_adapter, "pcie_mhi0");
+    else if (!access("/sys/class/net/rmnet_mhi0", F_OK))
+        strcpy(usbnet_adapter, "rmnet_mhi0");
+    else {
+        dbg_time("qmidevice_detect failed");
+        goto error;
+    }
+
+    if (!access("/dev/mhi_MBIM", F_OK)) {
+        strcpy(qmichannel, "/dev/mhi_MBIM");
+        profile->software_interface = SOFTWARE_MBIM;
+    }
+    else if (!access("/dev/mhi_QMI0", F_OK)) {
+        strcpy(qmichannel, "/dev/mhi_QMI0");
+        profile->software_interface = SOFTWARE_QMI;
+    }
+    else {
+        goto error;
+    }
+
+    return 1;
+error:
+    return 0;
+}
+
+#define USB_CLASS_COMM			2
+#define USB_CLASS_VENDOR_SPEC		0xff
+#define USB_CDC_SUBCLASS_MBIM			0x0e
+
+int get_driver_type(PROFILE_T *profile)
+{
+    char path[CM_MAX_PATHLEN+1] = {'\0'};
+    int bInterfaceClass;
+    int type = DRV_INVALID;
+
+    snprintf(path, sizeof(path), "/sys/class/net/%s/device/bInterfaceClass", profile->usbnet_adapter);
+    bInterfaceClass = file_get_value(path, 16);
+
+    /* QMI_WWAN */
+    if (bInterfaceClass == USB_CLASS_VENDOR_SPEC)
+        type = SOFTWARE_QMI;
+
+    /* CDC_MBIM */
+    if (bInterfaceClass == USB_CLASS_COMM)
+        type = SOFTWARE_MBIM;
+
+    return type;
+}
+
+struct usbfs_getdriver
+{
+    unsigned int interface;
+    char driver[255 + 1];
+};
+
+struct usbfs_ioctl
+{
+    int ifno;       /* interface 0..N ; negative numbers reserved */
+    int ioctl_code; /* MUST encode size + direction of data so the
+			 * macros in <asm/ioctl.h> give correct values */
+    void *data;     /* param buffer (in, or out) */
+};
+
+#define IOCTL_USBFS_DISCONNECT	_IO('U', 22)
+#define IOCTL_USBFS_CONNECT	_IO('U', 23)
+
+int usbfs_is_kernel_driver_alive(int fd, int ifnum)
+{
+    struct usbfs_getdriver getdrv;
+    getdrv.interface = ifnum;
+    if (ioctl(fd, USBDEVFS_GETDRIVER, &getdrv) < 0) {
+        dbg_time("%s ioctl USBDEVFS_GETDRIVER failed, kernel driver may be inactive", __func__);
+        return 0;
+    }
+    dbg_time("%s find interface %d has match the driver %s", __func__, ifnum, getdrv.driver);
+    return 1;
+}
+
+void usbfs_detach_kernel_driver(int fd, int ifnum)
+{
+    struct usbfs_ioctl operate;
+    operate.data = NULL;
+    operate.ifno = ifnum;
+    operate.ioctl_code = IOCTL_USBFS_DISCONNECT;
+    if (ioctl(fd, USBDEVFS_IOCTL, &operate) < 0) {
+        dbg_time("%s detach kernel driver failed", __func__);
+    } else {
+        dbg_time("%s detach kernel driver success", __func__);
+    }
+}
+
+void usbfs_attach_kernel_driver(int fd, int ifnum)
+{
+    struct usbfs_ioctl operate;
+    operate.data = NULL;
+    operate.ifno = ifnum;
+    operate.ioctl_code = IOCTL_USBFS_CONNECT;
+    if (ioctl(fd, USBDEVFS_IOCTL, &operate) < 0) {
+        dbg_time("%s detach kernel driver failed", __func__);
+    } else {
+        dbg_time("%s detach kernel driver success", __func__);
+    }
+}
+
+int reattach_driver(PROFILE_T *profile)
+{
+    int ifnum = 4;
+    int fd;
+    char devpath[128] = {'\0'};
+    snprintf(devpath, sizeof(devpath), "/dev/bus/usb/%03d/%03d", profile->busnum, profile->devnum);
+    fd = open(devpath, O_RDWR | O_NOCTTY);
+    if (fd < 0)
+    {
+        dbg_time("%s fail to open %s", __func__, devpath);
+        return -1;
+    }
+    usbfs_detach_kernel_driver(fd, ifnum);
+    usbfs_attach_kernel_driver(fd, ifnum);
+	close(fd);
+    return 0;
+}
+
+#define SIOCETHTOOL     0x8946
+int ql_get_netcard_driver_info(const char *devname)
+{
+    int fd = -1;
+    struct ethtool_drvinfo drvinfo;
+    struct ifreq ifr;	/* ifreq suitable for ethtool ioctl */
+
+    memset(&ifr, 0, sizeof(ifr));
+    strcpy(ifr.ifr_name, devname);
+
+    fd = socket(AF_INET, SOCK_DGRAM, 0);
+    if (fd < 0) {
+        dbg_time("Cannot get control socket: errno(%d)(%s)", errno, strerror(errno));
+        return -1;
+    }
+
+    drvinfo.cmd = ETHTOOL_GDRVINFO;
+    ifr.ifr_data = (void *)&drvinfo;
+
+    if (ioctl(fd, SIOCETHTOOL, &ifr) < 0) {
+        dbg_time("ioctl() error: errno(%d)(%s)", errno, strerror(errno));
+        return -1;
+    }
+
+    dbg_time("netcard driver = %s, driver version = %s", drvinfo.driver, drvinfo.version);
+	
+	close(fd);
+
+    return 0;
+}
+
+static void *catch_log(void *arg)
+{
+    PROFILE_T *profile = (PROFILE_T *)arg;
+    int nreads = 0;
+    char tbuff[256+32];
+    time_t t;
+    struct tm *tm;
+    char filter[10];
+    size_t tsize = strlen("2020/06/22_22:50:07 ");
+
+    sprintf(filter, ":%d:%03d:", profile->busnum, profile->devnum);
+
+    while(1) {
+        nreads = read(profile->usbmon_fd, tbuff + tsize, sizeof(tbuff) - tsize - 1);
+        if (nreads <= 0) {
+            break;
+        }
+
+        tbuff[tsize+nreads] = '\0';   // printf("%s", buff);
+
+        if (!strstr(tbuff+tsize, filter))
+            continue;
+
+        time(&t);
+        tm = localtime(&t);
+
+        sprintf(tbuff, "%04d/%02d/%02d_%02d:%02d:%02d", 
+                tm->tm_year+1900, tm->tm_mon+1, tm->tm_mday, tm->tm_hour, tm->tm_min, tm->tm_sec);
+        tbuff[tsize-1] = ' ';
+
+        write(profile->usbmon_logfile_fd, tbuff, strlen(tbuff));
+    }
+
+    return NULL;
+}
+
+int ql_capture_usbmon_log(PROFILE_T *profile, const char *log_path)
+{
+    char usbmon_path[64];
+    pthread_t pt;
+    pthread_attr_t attr;
+
+    if (access("/sys/module/usbmon", F_OK)) {
+        dbg_time("usbmon is not load, please execute \"modprobe usbmon\" or \"insmod usbmon.ko\"");
+        return -1;
+    }
+
+    if (access("/sys/kernel/debug/usb", F_OK)) {
+        dbg_time("debugfs is not mount, please execute \"mount -t debugfs none_debugs /sys/kernel/debug\"");
+        return -1;
+    }
+
+    sprintf(usbmon_path, "/sys/kernel/debug/usb/usbmon/%du", profile->busnum);
+    profile->usbmon_fd = open(usbmon_path, O_RDONLY);
+    if (profile->usbmon_fd < 0) {
+        dbg_time("open %s error(%d) (%s)", usbmon_path, errno, strerror(errno));
+        return -1;
+    }
+
+    profile->usbmon_logfile_fd = open(log_path, O_WRONLY | O_CREAT | O_APPEND, 0644);
+    if (profile->usbmon_logfile_fd < 0) {
+        dbg_time("open %s error(%d) (%s)", log_path, errno, strerror(errno));
+        close(profile->usbmon_fd);
+		profile->usbmon_fd = -1;
+        return -1;
+    }
+
+    pthread_attr_init(&attr);
+    pthread_attr_setdetachstate(&attr, PTHREAD_CREATE_DETACHED);
+
+    pthread_create(&pt, &attr, catch_log, (void *)profile);
+
+    return 0;
+} 
+
+void ql_stop_usbmon_log(PROFILE_T *profile) {
+	if (profile->usbmon_fd > 0)
+		close(profile->usbmon_fd);
+	if (profile->usbmon_logfile_fd > 0)
+		close(profile->usbmon_logfile_fd);
+}

root/package/link4all/quectel-CM/quectel1.6.0.15_src/libmnl/README

@@ -0,0 +1,28 @@
+= What is libmnl? =
+
+libmnl is a minimalistic user-space library oriented to Netlink developers.
+There are a lot of common tasks in parsing, validating, constructing of
+both the Netlink header and TLVs that are repetitive and easy to get wrong.
+This library aims to provide simple helpers that allows you to re-use code
+and to avoid re-inventing the wheel. The main features of this library are:
+
+* Small: the shared library requires around 30KB for an x86-based computer.
+* Simple: this library avoids complexity and elaborated abstractions that
+tend to hide Netlink details.
+* Easy to use: the library simplifies the work for Netlink-wise developers.
+It provides functions to make socket handling, message building, validating,
+parsing and sequence tracking, easier.
+* Easy to re-use: you can use the library to build your own abstraction layer
+on top of this library.
+* Decoupling: the interdependency of the main bricks that compose the library
+is reduced, i.e. the library provides many helpers, but the programmer is not
+forced to use them.
+
+= Example files =
+
+You can find several example files under examples/ that you can compile by
+invoking `make check'.
+
+--
+08/sep/2010
+Pablo Neira Ayuso <pablo@netfilter.org>

root/package/link4all/quectel-CM/quectel1.6.0.15_src/libmnl/attr.c

@@ -0,0 +1,722 @@
+/*
+ * (C) 2008-2012 by Pablo Neira Ayuso <pablo@netfilter.org>
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU Lesser General Public License as published
+ * by the Free Software Foundation; either version 2.1 of the License, or
+ * (at your option) any later version.
+ */
+#include <limits.h>	/* for INT_MAX */
+#include <string.h>
+#include <errno.h>
+
+#include "libmnl.h"
+
+/**
+ * \defgroup attr Netlink attribute helpers
+ *
+ * Netlink Type-Length-Value (TLV) attribute:
+ * \verbatim
+	|<-- 2 bytes -->|<-- 2 bytes -->|<-- variable -->|
+	-------------------------------------------------
+	|     length    |      type     |      value     |
+	-------------------------------------------------
+	|<--------- header ------------>|<-- payload --->|
+\endverbatim
+ * The payload of the Netlink message contains sequences of attributes that are
+ * expressed in TLV format.
+ *
+ * @{
+ */
+
+/**
+ * mnl_attr_get_type - get type of netlink attribute
+ * \param attr pointer to netlink attribute
+ *
+ * This function returns the attribute type.
+ */
+uint16_t mnl_attr_get_type(const struct nlattr *attr)
+{
+	return attr->nla_type & NLA_TYPE_MASK;
+}
+
+/**
+ * mnl_attr_get_len - get length of netlink attribute
+ * \param attr pointer to netlink attribute
+ *
+ * This function returns the attribute length that is the attribute header
+ * plus the attribute payload.
+ */
+uint16_t mnl_attr_get_len(const struct nlattr *attr)
+{
+	return attr->nla_len;
+}
+
+/**
+ * mnl_attr_get_payload_len - get the attribute payload-value length
+ * \param attr pointer to netlink attribute
+ *
+ * This function returns the attribute payload-value length.
+ */
+uint16_t mnl_attr_get_payload_len(const struct nlattr *attr)
+{
+	return attr->nla_len - MNL_ATTR_HDRLEN;
+}
+
+/**
+ * mnl_attr_get_payload - get pointer to the attribute payload
+ * \param attr pointer to netlink attribute
+ *
+ * This function return a pointer to the attribute payload.
+ */
+void *mnl_attr_get_payload(const struct nlattr *attr)
+{
+	return (void *)attr + MNL_ATTR_HDRLEN;
+}
+
+/**
+ * mnl_attr_ok - check if there is room for an attribute in a buffer
+ * \param attr attribute that we want to check if there is room for
+ * \param len remaining bytes in a buffer that contains the attribute
+ *
+ * This function is used to check that a buffer, which is supposed to contain
+ * an attribute, has enough room for the attribute that it stores, i.e. this
+ * function can be used to verify that an attribute is neither malformed nor
+ * truncated.
+ *
+ * This function does not set errno in case of error since it is intended
+ * for iterations. Thus, it returns true on success and false on error.
+ *
+ * The len parameter may be negative in the case of malformed messages during
+ * attribute iteration, that is why we use a signed integer.
+ */
+bool mnl_attr_ok(const struct nlattr *attr, int len)
+{
+	return len >= (int)sizeof(struct nlattr) &&
+	       attr->nla_len >= sizeof(struct nlattr) &&
+	       (int)attr->nla_len <= len;
+}
+
+/**
+ * mnl_attr_next - get the next attribute in the payload of a netlink message
+ * \param attr pointer to the current attribute
+ *
+ * This function returns a pointer to the next attribute after the one passed
+ * as parameter. You have to use mnl_attr_ok() to ensure that the next
+ * attribute is valid.
+ */
+struct nlattr *mnl_attr_next(const struct nlattr *attr)
+{
+	return (struct nlattr *)((void *)attr + MNL_ALIGN(attr->nla_len));
+}
+
+/**
+ * mnl_attr_type_valid - check if the attribute type is valid
+ * \param attr pointer to attribute to be checked
+ * \param max maximum attribute type
+ *
+ * This function allows to check if the attribute type is higher than the
+ * maximum supported type. If the attribute type is invalid, this function
+ * returns -1 and errno is explicitly set. On success, this function returns 1.
+ *
+ * Strict attribute checking in user-space is not a good idea since you may
+ * run an old application with a newer kernel that supports new attributes.
+ * This leads to backward compatibility breakages in user-space. Better check
+ * if you support an attribute, if not, skip it.
+ */
+int mnl_attr_type_valid(const struct nlattr *attr, uint16_t max)
+{
+	if (mnl_attr_get_type(attr) > max) {
+		errno = EOPNOTSUPP;
+		return -1;
+	}
+	return 1;
+}
+
+static int __mnl_attr_validate(const struct nlattr *attr,
+			       enum mnl_attr_data_type type, size_t exp_len)
+{
+	uint16_t attr_len = mnl_attr_get_payload_len(attr);
+	const char *attr_data = mnl_attr_get_payload(attr);
+
+	if (attr_len < exp_len) {
+		errno = ERANGE;
+		return -1;
+	}
+	switch(type) {
+	case MNL_TYPE_FLAG:
+		if (attr_len > 0) {
+			errno = ERANGE;
+			return -1;
+		}
+		break;
+	case MNL_TYPE_NUL_STRING:
+		if (attr_len == 0) {
+			errno = ERANGE;
+			return -1;
+		}
+		if (attr_data[attr_len-1] != '\0') {
+			errno = EINVAL;
+			return -1;
+		}
+		break;
+	case MNL_TYPE_STRING:
+		if (attr_len == 0) {
+			errno = ERANGE;
+			return -1;
+		}
+		break;
+	case MNL_TYPE_NESTED:
+		/* empty nested attributes are OK. */
+		if (attr_len == 0)
+			break;
+		/* if not empty, they must contain one header, eg. flag */
+		if (attr_len < MNL_ATTR_HDRLEN) {
+			errno = ERANGE;
+			return -1;
+		}
+		break;
+	default:
+		/* make gcc happy. */
+		break;
+	}
+	if (exp_len && attr_len > exp_len) {
+		errno = ERANGE;
+		return -1;
+	}
+	return 0;
+}
+
+static const size_t mnl_attr_data_type_len[MNL_TYPE_MAX] = {
+	[MNL_TYPE_U8]		= sizeof(uint8_t),
+	[MNL_TYPE_U16]		= sizeof(uint16_t),
+	[MNL_TYPE_U32]		= sizeof(uint32_t),
+	[MNL_TYPE_U64]		= sizeof(uint64_t),
+	[MNL_TYPE_MSECS]	= sizeof(uint64_t),
+};
+
+/**
+ * mnl_attr_validate - validate netlink attribute (simplified version)
+ * \param attr pointer to netlink attribute that we want to validate
+ * \param type data type (see enum mnl_attr_data_type)
+ *
+ * The validation is based on the data type. Specifically, it checks that
+ * integers (u8, u16, u32 and u64) have enough room for them. This function
+ * returns -1 in case of error, and errno is explicitly set.
+ */
+int mnl_attr_validate(const struct nlattr *attr, enum mnl_attr_data_type type)
+{
+	int exp_len;
+
+	if (type >= MNL_TYPE_MAX) {
+		errno = EINVAL;
+		return -1;
+	}
+	exp_len = mnl_attr_data_type_len[type];
+	return __mnl_attr_validate(attr, type, exp_len);
+}
+
+/**
+ * mnl_attr_validate2 - validate netlink attribute (extended version)
+ * \param attr pointer to netlink attribute that we want to validate
+ * \param type attribute type (see enum mnl_attr_data_type)
+ * \param exp_len expected attribute data size
+ *
+ * This function allows to perform a more accurate validation for attributes
+ * whose size is variable. If the size of the attribute is not what we expect,
+ * this functions returns -1 and errno is explicitly set.
+ */
+int mnl_attr_validate2(const struct nlattr *attr,
+				     enum mnl_attr_data_type type,
+				     size_t exp_len)
+{
+	if (type >= MNL_TYPE_MAX) {
+		errno = EINVAL;
+		return -1;
+	}
+	return __mnl_attr_validate(attr, type, exp_len);
+}
+
+/**
+ * mnl_attr_parse - parse attributes
+ * \param nlh pointer to netlink message
+ * \param offset offset to start parsing from (if payload is after any header)
+ * \param cb callback function that is called for each attribute
+ * \param data pointer to data that is passed to the callback function
+ *
+ * This function allows to iterate over the sequence of attributes that compose
+ * the Netlink message. You can then put the attribute in an array as it
+ * usually happens at this stage or you can use any other data structure (such
+ * as lists or trees).
+ *
+ * This function propagates the return value of the callback, which can be
+ * MNL_CB_ERROR, MNL_CB_OK or MNL_CB_STOP.
+ */
+int mnl_attr_parse(const struct nlmsghdr *nlh,
+				 unsigned int offset, mnl_attr_cb_t cb,
+				 void *data)
+{
+	int ret = MNL_CB_OK;
+	const struct nlattr *attr;
+
+	mnl_attr_for_each(attr, nlh, offset)
+		if ((ret = cb(attr, data)) <= MNL_CB_STOP)
+			return ret;
+	return ret;
+}
+
+/**
+ * mnl_attr_parse_nested - parse attributes inside a nest
+ * \param nested pointer to netlink attribute that contains a nest
+ * \param cb callback function that is called for each attribute in the nest
+ * \param data pointer to data passed to the callback function
+ *
+ * This function allows to iterate over the sequence of attributes that compose
+ * the Netlink message. You can then put the attribute in an array as it
+ * usually happens at this stage or you can use any other data structure (such
+ * as lists or trees).
+ *
+ * This function propagates the return value of the callback, which can be
+ * MNL_CB_ERROR, MNL_CB_OK or MNL_CB_STOP.
+ */
+int mnl_attr_parse_nested(const struct nlattr *nested,
+					mnl_attr_cb_t cb, void *data)
+{
+	int ret = MNL_CB_OK;
+	const struct nlattr *attr;
+
+	mnl_attr_for_each_nested(attr, nested)
+		if ((ret = cb(attr, data)) <= MNL_CB_STOP)
+			return ret;
+	return ret;
+}
+
+/**
+ * mnl_attr_parse_payload - parse attributes in payload of Netlink message
+ * \param payload pointer to payload of the Netlink message
+ * \param payload_len payload length that contains the attributes
+ * \param cb callback function that is called for each attribute
+ * \param data pointer to data that is passed to the callback function
+ *
+ * This function takes a pointer to the area that contains the attributes,
+ * commonly known as the payload of the Netlink message. Thus, you have to
+ * pass a pointer to the Netlink message payload, instead of the entire
+ * message.
+ *
+ * This function allows you to iterate over the sequence of attributes that are
+ * located at some payload offset. You can then put the attributes in one array
+ * as usual, or you can use any other data structure (such as lists or trees).
+ *
+ * This function propagates the return value of the callback, which can be
+ * MNL_CB_ERROR, MNL_CB_OK or MNL_CB_STOP.
+ */
+int mnl_attr_parse_payload(const void *payload,
+					 size_t payload_len,
+					 mnl_attr_cb_t cb, void *data)
+{
+	int ret = MNL_CB_OK;
+	const struct nlattr *attr;
+
+	mnl_attr_for_each_payload(payload, payload_len)
+		if ((ret = cb(attr, data)) <= MNL_CB_STOP)
+			return ret;
+	return ret;
+}
+
+/**
+ * mnl_attr_get_u8 - returns 8-bit unsigned integer attribute payload
+ * \param attr pointer to netlink attribute
+ *
+ * This function returns the 8-bit value of the attribute payload.
+ */
+uint8_t mnl_attr_get_u8(const struct nlattr *attr)
+{
+	return *((uint8_t *)mnl_attr_get_payload(attr));
+}
+
+/**
+ * mnl_attr_get_u16 - returns 16-bit unsigned integer attribute payload
+ * \param attr pointer to netlink attribute
+ *
+ * This function returns the 16-bit value of the attribute payload.
+ */
+uint16_t mnl_attr_get_u16(const struct nlattr *attr)
+{
+	return *((uint16_t *)mnl_attr_get_payload(attr));
+}
+
+/**
+ * mnl_attr_get_u32 - returns 32-bit unsigned integer attribute payload
+ * \param attr pointer to netlink attribute
+ *
+ * This function returns the 32-bit value of the attribute payload.
+ */
+uint32_t mnl_attr_get_u32(const struct nlattr *attr)
+{
+	return *((uint32_t *)mnl_attr_get_payload(attr));
+}
+
+/**
+ * mnl_attr_get_u64 - returns 64-bit unsigned integer attribute.
+ * \param attr pointer to netlink attribute
+ *
+ * This function returns the 64-bit value of the attribute payload. This
+ * function is align-safe, since accessing 64-bit Netlink attributes is a
+ * common source of alignment issues.
+ */
+uint64_t mnl_attr_get_u64(const struct nlattr *attr)
+{
+	uint64_t tmp;
+	memcpy(&tmp, mnl_attr_get_payload(attr), sizeof(tmp));
+	return tmp;
+}
+
+/**
+ * mnl_attr_get_str - returns pointer to string attribute.
+ * \param attr pointer to netlink attribute
+ *
+ * This function returns the payload of string attribute value.
+ */
+const char *mnl_attr_get_str(const struct nlattr *attr)
+{
+	return mnl_attr_get_payload(attr);
+}
+
+/**
+ * mnl_attr_put - add an attribute to netlink message
+ * \param nlh pointer to the netlink message
+ * \param type netlink attribute type that you want to add
+ * \param len netlink attribute payload length
+ * \param data pointer to the data that will be stored by the new attribute
+ *
+ * This function updates the length field of the Netlink message (nlmsg_len)
+ * by adding the size (header + payload) of the new attribute.
+ */
+void mnl_attr_put(struct nlmsghdr *nlh, uint16_t type,
+				size_t len, const void *data)
+{
+	struct nlattr *attr = mnl_nlmsg_get_payload_tail(nlh);
+	uint16_t payload_len = MNL_ALIGN(sizeof(struct nlattr)) + len;
+	int pad;
+
+	attr->nla_type = type;
+	attr->nla_len = payload_len;
+	memcpy(mnl_attr_get_payload(attr), data, len);
+	pad = MNL_ALIGN(len) - len;
+	if (pad > 0)
+		memset(mnl_attr_get_payload(attr) + len, 0, pad);
+
+	nlh->nlmsg_len += MNL_ALIGN(payload_len);
+}
+
+/**
+ * mnl_attr_put_u8 - add 8-bit unsigned integer attribute to netlink message
+ * \param nlh pointer to the netlink message
+ * \param type netlink attribute type
+ * \param data 8-bit unsigned integer data that is stored by the new attribute
+ *
+ * This function updates the length field of the Netlink message (nlmsg_len)
+ * by adding the size (header + payload) of the new attribute.
+ */
+void mnl_attr_put_u8(struct nlmsghdr *nlh, uint16_t type,
+				   uint8_t data)
+{
+	mnl_attr_put(nlh, type, sizeof(uint8_t), &data);
+}
+
+/**
+ * mnl_attr_put_u16 - add 16-bit unsigned integer attribute to netlink message
+ * \param nlh pointer to the netlink message
+ * \param type netlink attribute type
+ * \param data 16-bit unsigned integer data that is stored by the new attribute
+ *
+ * This function updates the length field of the Netlink message (nlmsg_len)
+ * by adding the size (header + payload) of the new attribute.
+ */
+void mnl_attr_put_u16(struct nlmsghdr *nlh, uint16_t type,
+				    uint16_t data)
+{
+	mnl_attr_put(nlh, type, sizeof(uint16_t), &data);
+}
+
+/**
+ * mnl_attr_put_u32 - add 32-bit unsigned integer attribute to netlink message
+ * \param nlh pointer to the netlink message
+ * \param type netlink attribute type
+ * \param data 32-bit unsigned integer data that is stored by the new attribute
+ *
+ * This function updates the length field of the Netlink message (nlmsg_len)
+ * by adding the size (header + payload) of the new attribute.
+ */
+void mnl_attr_put_u32(struct nlmsghdr *nlh, uint16_t type,
+				    uint32_t data)
+{
+	mnl_attr_put(nlh, type, sizeof(uint32_t), &data);
+}
+
+/**
+ * mnl_attr_put_u64 - add 64-bit unsigned integer attribute to netlink message
+ * \param nlh pointer to the netlink message
+ * \param type netlink attribute type
+ * \param data 64-bit unsigned integer data that is stored by the new attribute
+ *
+ * This function updates the length field of the Netlink message (nlmsg_len)
+ * by adding the size (header + payload) of the new attribute.
+ */
+void mnl_attr_put_u64(struct nlmsghdr *nlh, uint16_t type,
+				    uint64_t data)
+{
+	mnl_attr_put(nlh, type, sizeof(uint64_t), &data);
+}
+
+/**
+ * mnl_attr_put_str - add string attribute to netlink message
+ * \param nlh  pointer to the netlink message
+ * \param type netlink attribute type
+ * \param data pointer to string data that is stored by the new attribute
+ *
+ * This function updates the length field of the Netlink message (nlmsg_len)
+ * by adding the size (header + payload) of the new attribute.
+ */
+void mnl_attr_put_str(struct nlmsghdr *nlh, uint16_t type,
+				    const char *data)
+{
+	mnl_attr_put(nlh, type, strlen(data), data);
+}
+
+/**
+ * mnl_attr_put_strz - add string attribute to netlink message
+ * \param nlh pointer to the netlink message
+ * \param type netlink attribute type
+ * \param data pointer to string data that is stored by the new attribute
+ *
+ * This function is similar to mnl_attr_put_str, but it includes the
+ * NUL/zero ('\0') terminator at the end of the string.
+ *
+ * This function updates the length field of the Netlink message (nlmsg_len)
+ * by adding the size (header + payload) of the new attribute.
+ */
+void mnl_attr_put_strz(struct nlmsghdr *nlh, uint16_t type,
+				     const char *data)
+{
+	mnl_attr_put(nlh, type, strlen(data)+1, data);
+}
+
+/**
+ * mnl_attr_nest_start - start an attribute nest
+ * \param nlh pointer to the netlink message
+ * \param type netlink attribute type
+ *
+ * This function adds the attribute header that identifies the beginning of
+ * an attribute nest. This function always returns a valid pointer to the
+ * beginning of the nest.
+ */
+struct nlattr *mnl_attr_nest_start(struct nlmsghdr *nlh,
+						 uint16_t type)
+{
+	struct nlattr *start = mnl_nlmsg_get_payload_tail(nlh);
+
+	/* set start->nla_len in mnl_attr_nest_end() */
+	start->nla_type = NLA_F_NESTED | type;
+	nlh->nlmsg_len += MNL_ALIGN(sizeof(struct nlattr));
+
+	return start;
+}
+
+/**
+ * mnl_attr_put_check - add an attribute to netlink message
+ * \param nlh pointer to the netlink message
+ * \param buflen size of buffer which stores the message
+ * \param type netlink attribute type that you want to add
+ * \param len netlink attribute payload length
+ * \param data pointer to the data that will be stored by the new attribute
+ *
+ * This function first checks that the data can be added to the message
+ * (fits into the buffer) and then updates the length field of the Netlink
+ * message (nlmsg_len) by adding the size (header + payload) of the new
+ * attribute. The function returns true if the attribute could be added
+ * to the message, otherwise false is returned.
+ */
+bool mnl_attr_put_check(struct nlmsghdr *nlh, size_t buflen,
+				      uint16_t type, size_t len,
+				      const void *data)
+{
+	if (nlh->nlmsg_len + MNL_ATTR_HDRLEN + MNL_ALIGN(len) > buflen)
+		return false;
+	mnl_attr_put(nlh, type, len, data);
+	return true;
+}
+
+/**
+ * mnl_attr_put_u8_check - add 8-bit unsigned int attribute to netlink message
+ * \param nlh pointer to the netlink message
+ * \param buflen size of buffer which stores the message
+ * \param type netlink attribute type
+ * \param data 8-bit unsigned integer data that is stored by the new attribute
+ *
+ * This function first checks that the data can be added to the message
+ * (fits into the buffer) and then updates the length field of the Netlink
+ * message (nlmsg_len) by adding the size (header + payload) of the new
+ * attribute. The function returns true if the attribute could be added
+ * to the message, otherwise false is returned.
+ */
+bool mnl_attr_put_u8_check(struct nlmsghdr *nlh, size_t buflen,
+					 uint16_t type, uint8_t data)
+{
+	return mnl_attr_put_check(nlh, buflen, type, sizeof(uint8_t), &data);
+}
+
+/**
+ * mnl_attr_put_u16_check - add 16-bit unsigned int attribute to netlink message
+ * \param nlh pointer to the netlink message
+ * \param buflen size of buffer which stores the message
+ * \param type netlink attribute type
+ * \param data 16-bit unsigned integer data that is stored by the new attribute
+ *
+ * This function first checks that the data can be added to the message
+ * (fits into the buffer) and then updates the length field of the Netlink
+ * message (nlmsg_len) by adding the size (header + payload) of the new
+ * attribute. The function returns true if the attribute could be added
+ * to the message, otherwise false is returned.
+ * This function updates the length field of the Netlink message (nlmsg_len)
+ * by adding the size (header + payload) of the new attribute.
+ */
+bool mnl_attr_put_u16_check(struct nlmsghdr *nlh, size_t buflen,
+					  uint16_t type, uint16_t data)
+{
+	return mnl_attr_put_check(nlh, buflen, type, sizeof(uint16_t), &data);
+}
+
+/**
+ * mnl_attr_put_u32_check - add 32-bit unsigned int attribute to netlink message
+ * \param nlh pointer to the netlink message
+ * \param buflen size of buffer which stores the message
+ * \param type netlink attribute type
+ * \param data 32-bit unsigned integer data that is stored by the new attribute
+ *
+ * This function first checks that the data can be added to the message
+ * (fits into the buffer) and then updates the length field of the Netlink
+ * message (nlmsg_len) by adding the size (header + payload) of the new
+ * attribute. The function returns true if the attribute could be added
+ * to the message, otherwise false is returned.
+ * This function updates the length field of the Netlink message (nlmsg_len)
+ * by adding the size (header + payload) of the new attribute.
+ */
+bool mnl_attr_put_u32_check(struct nlmsghdr *nlh, size_t buflen,
+					  uint16_t type, uint32_t data)
+{
+	return mnl_attr_put_check(nlh, buflen, type, sizeof(uint32_t), &data);
+}
+
+/**
+ * mnl_attr_put_u64_check - add 64-bit unsigned int attribute to netlink message
+ * \param nlh pointer to the netlink message
+ * \param buflen size of buffer which stores the message
+ * \param type netlink attribute type
+ * \param data 64-bit unsigned integer data that is stored by the new attribute
+ *
+ * This function first checks that the data can be added to the message
+ * (fits into the buffer) and then updates the length field of the Netlink
+ * message (nlmsg_len) by adding the size (header + payload) of the new
+ * attribute. The function returns true if the attribute could be added
+ * to the message, otherwise false is returned.
+ * This function updates the length field of the Netlink message (nlmsg_len)
+ * by adding the size (header + payload) of the new attribute.
+ */
+bool mnl_attr_put_u64_check(struct nlmsghdr *nlh, size_t buflen,
+					  uint16_t type, uint64_t data)
+{
+	return mnl_attr_put_check(nlh, buflen, type, sizeof(uint64_t), &data);
+}
+
+/**
+ * mnl_attr_put_str_check - add string attribute to netlink message
+ * \param nlh  pointer to the netlink message
+ * \param buflen size of buffer which stores the message
+ * \param type netlink attribute type
+ * \param data pointer to string data that is stored by the new attribute
+ *
+ * This function first checks that the data can be added to the message
+ * (fits into the buffer) and then updates the length field of the Netlink
+ * message (nlmsg_len) by adding the size (header + payload) of the new
+ * attribute. The function returns true if the attribute could be added
+ * to the message, otherwise false is returned.
+ * This function updates the length field of the Netlink message (nlmsg_len)
+ * by adding the size (header + payload) of the new attribute.
+ */
+bool mnl_attr_put_str_check(struct nlmsghdr *nlh, size_t buflen,
+					  uint16_t type, const char *data)
+{
+	return mnl_attr_put_check(nlh, buflen, type, strlen(data), data);
+}
+
+/**
+ * mnl_attr_put_strz_check - add string attribute to netlink message
+ * \param nlh pointer to the netlink message
+ * \param buflen size of buffer which stores the message
+ * \param type netlink attribute type
+ * \param data pointer to string data that is stored by the new attribute
+ *
+ * This function is similar to mnl_attr_put_str, but it includes the
+ * NUL/zero ('\0') terminator at the end of the string.
+ *
+ * This function first checks that the data can be added to the message
+ * (fits into the buffer) and then updates the length field of the Netlink
+ * message (nlmsg_len) by adding the size (header + payload) of the new
+ * attribute. The function returns true if the attribute could be added
+ * to the message, otherwise false is returned.
+ */
+bool mnl_attr_put_strz_check(struct nlmsghdr *nlh, size_t buflen,
+					   uint16_t type, const char *data)
+{
+	return mnl_attr_put_check(nlh, buflen, type, strlen(data)+1, data);
+}
+
+/**
+ * mnl_attr_nest_start_check - start an attribute nest
+ * \param buflen size of buffer which stores the message
+ * \param nlh pointer to the netlink message
+ * \param type netlink attribute type
+ *
+ * This function adds the attribute header that identifies the beginning of
+ * an attribute nest. If the nested attribute cannot be added then NULL,
+ * otherwise valid pointer to the beginning of the nest is returned.
+ */
+struct nlattr *mnl_attr_nest_start_check(struct nlmsghdr *nlh,
+						       size_t buflen,
+						       uint16_t type)
+{
+	if (nlh->nlmsg_len + MNL_ATTR_HDRLEN > buflen)
+		return NULL;
+	return mnl_attr_nest_start(nlh, type);
+}
+
+/**
+ * mnl_attr_nest_end - end an attribute nest
+ * \param nlh pointer to the netlink message
+ * \param start pointer to the attribute nest returned by mnl_attr_nest_start()
+ *
+ * This function updates the attribute header that identifies the nest.
+ */
+void mnl_attr_nest_end(struct nlmsghdr *nlh,
+				     struct nlattr *start)
+{
+	start->nla_len = mnl_nlmsg_get_payload_tail(nlh) - (void *)start;
+}
+
+/**
+ * mnl_attr_nest_cancel - cancel an attribute nest
+ * \param nlh pointer to the netlink message
+ * \param start pointer to the attribute nest returned by mnl_attr_nest_start()
+ *
+ * This function updates the attribute header that identifies the nest.
+ */
+void mnl_attr_nest_cancel(struct nlmsghdr *nlh,
+					struct nlattr *start)
+{
+	nlh->nlmsg_len -= mnl_nlmsg_get_payload_tail(nlh) - (void *)start;
+}
+
+/**
+ * @}
+ */

root/package/link4all/quectel-CM/quectel1.6.0.15_src/libmnl/callback.c

@@ -0,0 +1,167 @@
+/*
+ * (C) 2008-2010 by Pablo Neira Ayuso <pablo@netfilter.org>
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU Lesser General Public License as published
+ * by the Free Software Foundation; either version 2.1 of the License, or
+ * (at your option) any later version.
+ */
+
+#include <errno.h>
+
+#include "libmnl.h"
+
+static int mnl_cb_noop(const struct nlmsghdr *nlh, void *data)
+{
+	return MNL_CB_OK;
+}
+
+static int mnl_cb_error(const struct nlmsghdr *nlh, void *data)
+{
+	const struct nlmsgerr *err = mnl_nlmsg_get_payload(nlh);
+
+	if (nlh->nlmsg_len < mnl_nlmsg_size(sizeof(struct nlmsgerr))) {
+		errno = EBADMSG; 
+		return MNL_CB_ERROR;
+	}
+	/* Netlink subsystems returns the errno value with different signess */
+	if (err->error < 0)
+		errno = -err->error;
+	else
+		errno = err->error;
+
+	return err->error == 0 ? MNL_CB_STOP : MNL_CB_ERROR;
+}
+
+static int mnl_cb_stop(const struct nlmsghdr *nlh, void *data)
+{
+	return MNL_CB_STOP;
+}
+
+static const mnl_cb_t default_cb_array[NLMSG_MIN_TYPE] = {
+	[NLMSG_NOOP]	= mnl_cb_noop,
+	[NLMSG_ERROR]	= mnl_cb_error,
+	[NLMSG_DONE]	= mnl_cb_stop,
+	[NLMSG_OVERRUN]	= mnl_cb_noop,
+};
+
+static inline int __mnl_cb_run(const void *buf, size_t numbytes,
+			       unsigned int seq, unsigned int portid,
+			       mnl_cb_t cb_data, void *data,
+			       const mnl_cb_t *cb_ctl_array,
+			       unsigned int cb_ctl_array_len)
+{
+	int ret = MNL_CB_OK, len = numbytes;
+	const struct nlmsghdr *nlh = buf;
+
+	while (mnl_nlmsg_ok(nlh, len)) {
+		/* check message source */
+		if (!mnl_nlmsg_portid_ok(nlh, portid)) {
+			errno = ESRCH;
+			return -1;
+		}
+		/* perform sequence tracking */
+		if (!mnl_nlmsg_seq_ok(nlh, seq)) {
+			errno = EPROTO;
+			return -1;
+		}
+
+		/* dump was interrupted */
+		if (nlh->nlmsg_flags & NLM_F_DUMP_INTR) {
+			errno = EINTR;
+			return -1;
+		}
+
+		/* netlink data message handling */
+		if (nlh->nlmsg_type >= NLMSG_MIN_TYPE) { 
+			if (cb_data){
+				ret = cb_data(nlh, data);
+				if (ret <= MNL_CB_STOP)
+					goto out;
+			}
+		} else if (nlh->nlmsg_type < cb_ctl_array_len) {
+			if (cb_ctl_array && cb_ctl_array[nlh->nlmsg_type]) {
+				ret = cb_ctl_array[nlh->nlmsg_type](nlh, data);
+				if (ret <= MNL_CB_STOP)
+					goto out;
+			}
+		} else if (default_cb_array[nlh->nlmsg_type]) {
+			ret = default_cb_array[nlh->nlmsg_type](nlh, data);
+			if (ret <= MNL_CB_STOP)
+				goto out;
+		}
+		nlh = mnl_nlmsg_next(nlh, &len);
+	}
+out:
+	return ret;
+}
+
+/**
+ * \defgroup callback Callback helpers
+ * @{
+ */
+
+/**
+ * mnl_cb_run2 - callback runqueue for netlink messages
+ * \param buf buffer that contains the netlink messages
+ * \param numbytes number of bytes stored in the buffer
+ * \param seq sequence number that we expect to receive
+ * \param portid Netlink PortID that we expect to receive
+ * \param cb_data callback handler for data messages
+ * \param data pointer to data that will be passed to the data callback handler
+ * \param cb_ctl_array array of custom callback handlers from control messages
+ * \param cb_ctl_array_len array length of custom control callback handlers
+ *
+ * You can set the cb_ctl_array to NULL if you want to use the default control
+ * callback handlers, in that case, the parameter cb_ctl_array_len is not
+ * checked.
+ *
+ * Your callback may return three possible values:
+ * 	- MNL_CB_ERROR (<=-1): an error has occurred. Stop callback runqueue.
+ * 	- MNL_CB_STOP (=0): stop callback runqueue.
+ * 	- MNL_CB_OK (>=1): no problem has occurred.
+ *
+ * This function propagates the callback return value. On error, it returns
+ * -1 and errno is explicitly set. If the portID is not the expected, errno
+ * is set to ESRCH. If the sequence number is not the expected, errno is set
+ * to EPROTO. If the dump was interrupted, errno is set to EINTR and you should
+ * request a new fresh dump again.
+ */
+int mnl_cb_run2(const void *buf, size_t numbytes,
+			      unsigned int seq, unsigned int portid,
+			      mnl_cb_t cb_data, void *data,
+			      const mnl_cb_t *cb_ctl_array,
+			      unsigned int cb_ctl_array_len)
+{
+	return __mnl_cb_run(buf, numbytes, seq, portid, cb_data, data,
+			    cb_ctl_array, cb_ctl_array_len);
+}
+
+/**
+ * mnl_cb_run - callback runqueue for netlink messages (simplified version)
+ * \param buf buffer that contains the netlink messages
+ * \param numbytes number of bytes stored in the buffer
+ * \param seq sequence number that we expect to receive
+ * \param portid Netlink PortID that we expect to receive
+ * \param cb_data callback handler for data messages
+ * \param data pointer to data that will be passed to the data callback handler
+ *
+ * This function is like mnl_cb_run2() but it does not allow you to set
+ * the control callback handlers.
+ *
+ * Your callback may return three possible values:
+ * 	- MNL_CB_ERROR (<=-1): an error has occurred. Stop callback runqueue.
+ * 	- MNL_CB_STOP (=0): stop callback runqueue.
+ * 	- MNL_CB_OK (>=1): no problems has occurred.
+ *
+ * This function propagates the callback return value.
+ */
+int mnl_cb_run(const void *buf, size_t numbytes, unsigned int seq,
+			     unsigned int portid, mnl_cb_t cb_data, void *data)
+{
+	return __mnl_cb_run(buf, numbytes, seq, portid, cb_data, data, NULL, 0);
+}
+
+/**
+ * @}
+ */

root/package/link4all/quectel-CM/quectel1.6.0.15_src/libmnl/dhcp/dhcp.h

@@ -0,0 +1,5 @@
+#ifndef __DHCP_H__
+#define __DHCP_H__
+
+int do_dhcp(char *iname);
+#endif //__DHCP_H__

root/package/link4all/quectel-CM/quectel1.6.0.15_src/libmnl/dhcp/dhcpclient.c

@@ -0,0 +1,515 @@
+/*
+ * Copyright 2008, The Android Open Source Project
+ *
+ * Licensed under the Apache License, Version 2.0 (the "License");
+ * you may not use this file except in compliance with the License.
+ * You may obtain a copy of the License at
+ *
+ *     http://www.apache.org/licenses/LICENSE-2.0
+ *
+ * Unless required by applicable law or agreed to in writing, software
+ * distributed under the License is distributed on an "AS IS" BASIS,
+ * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
+ * See the License for the specific language governing permissions and
+ * limitations under the License.
+ */
+#include <dirent.h>
+#include <errno.h>
+#include <poll.h>
+#include <netinet/in.h>
+#include <stdarg.h>
+#include <stdlib.h>
+#include <stdio.h>
+#include <string.h>
+#include <sys/select.h>
+#include <sys/socket.h>
+#include <sys/time.h>
+#include <sys/types.h>
+#include <net/if.h>
+#include <time.h>
+#include <unistd.h>
+#include <net/if.h>
+
+#include "../ifutils.h"
+#include "dhcpmsg.h"
+#include "packet.h"
+
+#define VERBOSE 2
+
+static int verbose = 1;
+static char errmsg[2048];
+
+typedef unsigned long long msecs_t;
+#if VERBOSE
+void dump_dhcp_msg();
+#endif
+
+msecs_t get_msecs(void)
+{
+    struct timespec ts;
+
+    if (clock_gettime(CLOCK_MONOTONIC, &ts)) {
+        return 0;
+    } else {
+        return (((msecs_t) ts.tv_sec) * ((msecs_t) 1000)) +
+            (((msecs_t) ts.tv_nsec) / ((msecs_t) 1000000));
+    }
+}
+
+void printerr(char *fmt, ...)
+{
+    va_list ap;
+
+    va_start(ap, fmt);
+    vsnprintf(errmsg, sizeof(errmsg), fmt, ap);
+    va_end(ap);
+
+    printf("%s\n", errmsg);
+}
+
+const char *dhcp_lasterror()
+{
+    return errmsg;
+}
+
+int fatal(const char *reason)
+{
+    printerr("%s: %s\n", reason, strerror(errno));
+    return -1;
+//    exit(1);
+}
+
+typedef struct dhcp_info dhcp_info;
+
+struct dhcp_info {
+    uint32_t type;
+
+    uint32_t ipaddr;
+    uint32_t gateway;
+    uint32_t prefixLength;
+
+    uint32_t dns1;
+    uint32_t dns2;
+
+    uint32_t serveraddr;
+    uint32_t lease;
+};
+
+dhcp_info last_good_info;
+
+void get_dhcp_info(uint32_t *ipaddr, uint32_t *gateway, uint32_t *prefixLength,
+                   uint32_t *dns1, uint32_t *dns2, uint32_t *server,
+                   uint32_t *lease)
+{
+    *ipaddr = last_good_info.ipaddr;
+    *gateway = last_good_info.gateway;
+    *prefixLength = last_good_info.prefixLength;
+    *dns1 = last_good_info.dns1;
+    *dns2 = last_good_info.dns2;
+    *server = last_good_info.serveraddr;
+    *lease = last_good_info.lease;
+}
+
+static int dhcp_configure(const char *ifname, dhcp_info *info)
+{
+    last_good_info = *info;
+    return if_set_network_v4(ifname, info->ipaddr, info->prefixLength, info->gateway,
+                         info->dns1, info->dns2);
+}
+
+static const char *dhcp_type_to_name(uint32_t type)
+{
+    switch(type) {
+    case DHCPDISCOVER: return "discover";
+    case DHCPOFFER:    return "offer";
+    case DHCPREQUEST:  return "request";
+    case DHCPDECLINE:  return "decline";
+    case DHCPACK:      return "ack";
+    case DHCPNAK:      return "nak";
+    case DHCPRELEASE:  return "release";
+    case DHCPINFORM:   return "inform";
+    default:           return "???";
+    }
+}
+
+void dump_dhcp_info(dhcp_info *info)
+{
+    char addr[20], gway[20];
+    printf("--- dhcp %s (%d) ---\n",
+            dhcp_type_to_name(info->type), info->type);
+    strcpy(addr, ipaddr_to_string_v4(info->ipaddr));
+    strcpy(gway, ipaddr_to_string_v4(info->gateway));
+    printf("ip %s gw %s prefixLength %d\n", addr, gway, info->prefixLength);
+    if (info->dns1) printf("dns1: %s\n", ipaddr_to_string_v4(info->dns1));
+    if (info->dns2) printf("dns2: %s\n", ipaddr_to_string_v4(info->dns2));
+    printf("server %s, lease %d seconds\n",
+            ipaddr_to_string_v4(info->serveraddr), info->lease);
+}
+
+
+int decode_dhcp_msg(dhcp_msg *msg, int len, dhcp_info *info)
+{
+    uint8_t *x;
+    unsigned int opt;
+    int optlen;
+
+    memset(info, 0, sizeof(dhcp_info));
+    if (len < (DHCP_MSG_FIXED_SIZE + 4)) return -1;
+
+    len -= (DHCP_MSG_FIXED_SIZE + 4);
+
+    if (msg->options[0] != OPT_COOKIE1) return -1;
+    if (msg->options[1] != OPT_COOKIE2) return -1;
+    if (msg->options[2] != OPT_COOKIE3) return -1;
+    if (msg->options[3] != OPT_COOKIE4) return -1;
+
+    x = msg->options + 4;
+
+    while (len > 2) {
+        opt = *x++;
+        if (opt == OPT_PAD) {
+            len--;
+            continue;
+        }
+        if (opt == OPT_END) {
+            break;
+        }
+        optlen = *x++;
+        len -= 2;
+        if (optlen > len) {
+            break;
+        }
+        switch(opt) {
+        case OPT_SUBNET_MASK:
+            if (optlen >= 4) {
+                in_addr_t mask;
+                memcpy(&mask, x, 4);
+                info->prefixLength = mask_to_prefix_v4(mask);
+            }
+            break;
+        case OPT_GATEWAY:
+            if (optlen >= 4) memcpy(&info->gateway, x, 4);
+            break;
+        case OPT_DNS:
+            if (optlen >= 4) memcpy(&info->dns1, x + 0, 4);
+            if (optlen >= 8) memcpy(&info->dns2, x + 4, 4);
+            break;
+        case OPT_LEASE_TIME:
+            if (optlen >= 4) {
+                memcpy(&info->lease, x, 4);
+                info->lease = ntohl(info->lease);
+            }
+            break;
+        case OPT_SERVER_ID:
+            if (optlen >= 4) memcpy(&info->serveraddr, x, 4);
+            break;
+        case OPT_MESSAGE_TYPE:
+            info->type = *x;
+            break;
+        default:
+            break;
+        }
+        x += optlen;
+        len -= optlen;
+    }
+
+    info->ipaddr = msg->yiaddr;
+
+    return 0;
+}
+
+#if VERBOSE
+
+static void hex2str(char *buf, size_t buf_size, const unsigned char *array, int len)
+{
+    int i;
+    char *cp = buf;
+    char *buf_end = buf + buf_size;
+    for (i = 0; i < len; i++) {
+        cp += snprintf(cp, buf_end - cp, " %02x ", array[i]);
+    }
+}
+
+void dump_dhcp_msg(dhcp_msg *msg, int len)
+{
+    unsigned char *x;
+    unsigned int n,c;
+    int optsz;
+    const char *name;
+    char buf[2048];
+
+    if (len < DHCP_MSG_FIXED_SIZE) {
+        printf("Invalid length %d, should be %d", len, DHCP_MSG_FIXED_SIZE);
+        return;
+    }
+
+    len -= DHCP_MSG_FIXED_SIZE;
+
+    if (msg->op == OP_BOOTREQUEST)
+        name = "BOOTREQUEST";
+    else if (msg->op == OP_BOOTREPLY)
+        name = "BOOTREPLY";
+    else
+        name = "????";
+
+    c = msg->hlen > 16 ? 16 : msg->hlen;
+    hex2str(buf, sizeof(buf), msg->chaddr, c);
+
+    for (n = 0; n < 64; n++) {
+        unsigned char x = msg->sname[n];
+        if ((x < ' ') || (x > 127)) {
+            if (x == 0) break;
+            msg->sname[n] = '.';
+        }
+    }
+    msg->sname[63] = 0;
+
+    for (n = 0; n < 128; n++) {
+        unsigned char x = msg->file[n];
+        if ((x < ' ') || (x > 127)) {
+            if (x == 0) break;
+            msg->file[n] = '.';
+        }
+    }
+    msg->file[127] = 0;
+
+    if (len < 4) return;
+    len -= 4;
+    x = msg->options + 4;
+
+    while (len > 2) {
+        if (*x == 0) {
+            x++;
+            len--;
+            continue;
+        }
+        if (*x == OPT_END) {
+            break;
+        }
+        len -= 2;
+        optsz = x[1];
+        if (optsz > len) break;
+        if (x[0] == OPT_DOMAIN_NAME || x[0] == OPT_MESSAGE) {
+            if ((unsigned int)optsz < sizeof(buf) - 1) {
+                n = optsz;
+            } else {
+                n = sizeof(buf) - 1;
+            }
+            memcpy(buf, &x[2], n);
+            buf[n] = '\0';
+        } else {
+            hex2str(buf, sizeof(buf), &x[2], optsz);
+        }
+        if (x[0] == OPT_MESSAGE_TYPE)
+            name = dhcp_type_to_name(x[2]);
+        else
+            name = NULL;
+        len -= optsz;
+        x = x + optsz + 2;
+    }
+}
+
+#endif
+
+static int send_message(int sock, int if_index, dhcp_msg  *msg, int size)
+{
+#if VERBOSE > 1
+    dump_dhcp_msg(msg, size);
+#endif
+    return send_packet(sock, if_index, msg, size, INADDR_ANY, INADDR_BROADCAST,
+                       PORT_BOOTP_CLIENT, PORT_BOOTP_SERVER);
+}
+
+static int is_valid_reply(dhcp_msg *msg, dhcp_msg *reply, int sz)
+{
+    if (sz < DHCP_MSG_FIXED_SIZE) {
+        if (verbose) printf("Wrong size %d != %d\n", sz, DHCP_MSG_FIXED_SIZE);
+        return 0;
+    }
+    if (reply->op != OP_BOOTREPLY) {
+        if (verbose) printf("Wrong Op %d != %d\n", reply->op, OP_BOOTREPLY);
+        return 0;
+    }
+    if (reply->xid != msg->xid) {
+        if (verbose) printf("Wrong Xid 0x%x != 0x%x\n", ntohl(reply->xid),
+                           ntohl(msg->xid));
+        return 0;
+    }
+    if (reply->htype != msg->htype) {
+        if (verbose) printf("Wrong Htype %d != %d\n", reply->htype, msg->htype);
+        return 0;
+    }
+    if (reply->hlen != msg->hlen) {
+        if (verbose) printf("Wrong Hlen %d != %d\n", reply->hlen, msg->hlen);
+        return 0;
+    }
+    if (memcmp(msg->chaddr, reply->chaddr, msg->hlen)) {
+        if (verbose) printf("Wrong chaddr %x != %x\n", *(reply->chaddr),*(msg->chaddr));
+        return 0;
+    }
+    return 1;
+}
+
+#define STATE_SELECTING  1
+#define STATE_REQUESTING 2
+
+#define TIMEOUT_INITIAL   4000
+#define TIMEOUT_MAX      32000
+
+int dhcp_init_ifc(const char *ifname)
+{
+    dhcp_msg discover_msg;
+    dhcp_msg request_msg;
+    dhcp_msg reply;
+    dhcp_msg *msg;
+    dhcp_info info;
+    int s, r, size;
+    int valid_reply;
+    uint32_t xid;
+    unsigned char hwaddr[6];
+    struct pollfd pfd;
+    unsigned int state;
+    unsigned int timeout;
+    int if_index;
+
+    xid = (uint32_t) get_msecs();
+
+    if (if_get_hwaddr(ifname, hwaddr)) {
+        return fatal("cannot obtain interface address");
+    }
+    if ((if_index = if_nametoindex(ifname)) == 0) {
+        return fatal("cannot obtain interface index");
+    }
+
+    s = open_raw_socket(ifname, hwaddr, if_index);
+
+    timeout = TIMEOUT_INITIAL;
+    state = STATE_SELECTING;
+    info.type = 0;
+    goto transmit;
+
+    for (;;) {
+        pfd.fd = s;
+        pfd.events = POLLIN;
+        pfd.revents = 0;
+        r = poll(&pfd, 1, timeout);
+
+        if (r == 0) {
+#if VERBOSE
+            printerr("TIMEOUT\n");
+#endif
+            if (timeout >= TIMEOUT_MAX) {
+                printerr("timed out\n");
+                if ( info.type == DHCPOFFER ) {
+                    printerr("no acknowledgement from DHCP server\nconfiguring %s with offered parameters\n", ifname);
+                    return dhcp_configure(ifname, &info);
+                }
+                errno = ETIME;
+                close(s);
+                return -1;
+            }
+            timeout = timeout * 2;
+
+        transmit:
+            size = 0;
+            msg = NULL;
+            switch(state) {
+            case STATE_SELECTING:
+                msg = &discover_msg;
+                size = init_dhcp_discover_msg(msg, hwaddr, xid);
+                break;
+            case STATE_REQUESTING:
+                msg = &request_msg;
+                size = init_dhcp_request_msg(msg, hwaddr, xid, info.ipaddr, info.serveraddr);
+                break;
+            default:
+                r = 0;
+            }
+            if (size != 0) {
+                r = send_message(s, if_index, msg, size);
+                if (r < 0) {
+                    printerr("error sending dhcp msg: %s\n", strerror(errno));
+                }
+            }
+            continue;
+        }
+
+        if (r < 0) {
+            if ((errno == EAGAIN) || (errno == EINTR)) {
+                continue;
+            }
+            return fatal("poll failed");
+        }
+
+        errno = 0;
+        r = receive_packet(s, &reply);
+        if (r < 0) {
+            if (errno != 0) {
+                printf("receive_packet failed (%d): %s", r, strerror(errno));
+                if (errno == ENETDOWN || errno == ENXIO) {
+                    return -1;
+                }
+            }
+            continue;
+        }
+
+#if VERBOSE > 1
+        dump_dhcp_msg(&reply, r);
+#endif
+        decode_dhcp_msg(&reply, r, &info);
+
+        if (state == STATE_SELECTING) {
+            valid_reply = is_valid_reply(&discover_msg, &reply, r);
+        } else {
+            valid_reply = is_valid_reply(&request_msg, &reply, r);
+        }
+        if (!valid_reply) {
+            printerr("invalid reply\n");
+            continue;
+        }
+
+        if (verbose) dump_dhcp_info(&info);
+
+        switch(state) {
+        case STATE_SELECTING:
+            if (info.type == DHCPOFFER) {
+                state = STATE_REQUESTING;
+                timeout = TIMEOUT_INITIAL;
+                xid++;
+                goto transmit;
+            }
+            break;
+        case STATE_REQUESTING:
+            if (info.type == DHCPACK) {
+                printerr("configuring %s\n", ifname);
+                close(s);
+                return dhcp_configure(ifname, &info);
+            } else if (info.type == DHCPNAK) {
+                printerr("configuration request denied\n");
+                close(s);
+                return -1;
+            } else {
+                printerr("ignoring %s message in state %d\n",
+                         dhcp_type_to_name(info.type), state);
+            }
+            break;
+        }
+    }
+    close(s);
+    return 0;
+}
+
+int do_dhcp(char *iname)
+{
+    if (if_set_addr_v4(iname, 0, 32)) {
+        printerr("failed to set ip addr for %s to 0.0.0.0: %s\n", iname, strerror(errno));
+        return -1;
+    }
+
+    if (if_link_up(iname)) {
+        printerr("failed to bring up interface %s: %s\n", iname, strerror(errno));
+        return -1;
+    }
+
+    return dhcp_init_ifc(iname);
+}

root/package/link4all/quectel-CM/quectel1.6.0.15_src/libmnl/dhcp/dhcpmsg.c

@@ -0,0 +1,100 @@
+/*
+ * Copyright 2008, The Android Open Source Project
+ *
+ * Licensed under the Apache License, Version 2.0 (the "License");
+ * you may not use this file except in compliance with the License.
+ * You may obtain a copy of the License at
+ *
+ *     http://www.apache.org/licenses/LICENSE-2.0
+ *
+ * Unless required by applicable law or agreed to in writing, software
+ * distributed under the License is distributed on an "AS IS" BASIS,
+ * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
+ * See the License for the specific language governing permissions and
+ * limitations under the License.
+ */
+
+#include <stdio.h>
+#include <stdarg.h>
+#include <string.h>
+#include <netinet/in.h>
+
+#include "dhcpmsg.h"
+
+static void *init_dhcp_msg(dhcp_msg *msg, int type, void *hwaddr, uint32_t xid)
+{
+    uint8_t *x;
+
+    memset(msg, 0, sizeof(dhcp_msg));
+
+    msg->op = OP_BOOTREQUEST;
+    msg->htype = HTYPE_ETHER;
+    msg->hlen = 6;
+    msg->hops = 0;
+
+    msg->flags = htons(FLAGS_BROADCAST);
+
+    msg->xid = xid;
+
+    memcpy(msg->chaddr, hwaddr, 6);
+
+    x = msg->options;
+
+    *x++ = OPT_COOKIE1;
+    *x++ = OPT_COOKIE2;
+    *x++ = OPT_COOKIE3;
+    *x++ = OPT_COOKIE4;
+
+    *x++ = OPT_MESSAGE_TYPE;
+    *x++ = 1;
+    *x++ = type;
+
+    return x;
+}
+
+int init_dhcp_discover_msg(dhcp_msg *msg, void *hwaddr, uint32_t xid)
+{
+    uint8_t *x;
+
+    x = init_dhcp_msg(msg, DHCPDISCOVER, hwaddr, xid);
+
+    *x++ = OPT_PARAMETER_LIST;
+    *x++ = 4;
+    *x++ = OPT_SUBNET_MASK;
+    *x++ = OPT_GATEWAY;
+    *x++ = OPT_DNS;
+    *x++ = OPT_BROADCAST_ADDR;
+
+    *x++ = OPT_END;
+
+    return DHCP_MSG_FIXED_SIZE + (x - msg->options);
+}
+
+int init_dhcp_request_msg(dhcp_msg *msg, void *hwaddr, uint32_t xid,
+                          uint32_t ipaddr, uint32_t serveraddr)
+{
+    uint8_t *x;
+
+    x = init_dhcp_msg(msg, DHCPREQUEST, hwaddr, xid);
+
+    *x++ = OPT_PARAMETER_LIST;
+    *x++ = 4;
+    *x++ = OPT_SUBNET_MASK;
+    *x++ = OPT_GATEWAY;
+    *x++ = OPT_DNS;
+    *x++ = OPT_BROADCAST_ADDR;
+
+    *x++ = OPT_REQUESTED_IP;
+    *x++ = 4;
+    memcpy(x, &ipaddr, 4);
+    x +=  4;
+
+    *x++ = OPT_SERVER_ID;
+    *x++ = 4;
+    memcpy(x, &serveraddr, 4);
+    x += 4;
+
+    *x++ = OPT_END;
+
+    return DHCP_MSG_FIXED_SIZE + (x - msg->options);
+}

root/package/link4all/quectel-CM/quectel1.6.0.15_src/libmnl/dhcp/dhcpmsg.h

@@ -0,0 +1,106 @@
+/*
+ * Copyright 2008, The Android Open Source Project
+ *
+ * Licensed under the Apache License, Version 2.0 (the "License"); 
+ * you may not use this file except in compliance with the License. 
+ * You may obtain a copy of the License at 
+ *
+ *     http://www.apache.org/licenses/LICENSE-2.0 
+ *
+ * Unless required by applicable law or agreed to in writing, software 
+ * distributed under the License is distributed on an "AS IS" BASIS, 
+ * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. 
+ * See the License for the specific language governing permissions and 
+ * limitations under the License.
+ */
+
+#ifndef _WIFI_DHCP_H_
+#define _WIFI_DHCP_H_
+
+#include <stdint.h>
+
+#define PORT_BOOTP_SERVER 67
+#define PORT_BOOTP_CLIENT 68
+
+/* RFC 2131 p 9 */
+typedef struct dhcp_msg dhcp_msg;
+
+#define OP_BOOTREQUEST 1
+#define OP_BOOTREPLY   2
+
+#define FLAGS_BROADCAST 0x8000
+
+#define HTYPE_ETHER    1
+
+struct dhcp_msg
+{
+    uint8_t op;           /* BOOTREQUEST / BOOTREPLY    */
+    uint8_t htype;        /* hw addr type               */
+    uint8_t hlen;         /* hw addr len                */
+    uint8_t hops;         /* client set to 0            */
+    
+    uint32_t xid;         /* transaction id             */
+
+    uint16_t secs;        /* seconds since start of acq */
+    uint16_t flags;
+
+    uint32_t ciaddr;      /* client IP addr             */
+    uint32_t yiaddr;      /* your (client) IP addr      */
+    uint32_t siaddr;      /* ip addr of next server     */
+                          /* (DHCPOFFER and DHCPACK)    */
+    uint32_t giaddr;      /* relay agent IP addr        */
+
+    uint8_t chaddr[16];  /* client hw addr             */
+    char sname[64];      /* asciiz server hostname     */
+    char file[128];      /* asciiz boot file name      */
+
+    uint8_t options[1024];  /* optional parameters        */
+};
+
+#define DHCP_MSG_FIXED_SIZE 236
+
+/* first four bytes of options are a cookie to indicate that
+** the payload are DHCP options as opposed to some other BOOTP
+** extension.
+*/
+#define OPT_COOKIE1          0x63
+#define OPT_COOKIE2          0x82
+#define OPT_COOKIE3          0x53
+#define OPT_COOKIE4          0x63
+
+/* BOOTP/DHCP options - see RFC 2132 */
+#define OPT_PAD              0
+
+#define OPT_SUBNET_MASK      1     /* 4 <ipaddr> */
+#define OPT_TIME_OFFSET      2     /* 4 <seconds> */
+#define OPT_GATEWAY          3     /* 4*n <ipaddr> * n */
+#define OPT_DNS              6     /* 4*n <ipaddr> * n */
+#define OPT_DOMAIN_NAME      15    /* n <domainnamestring> */
+#define OPT_BROADCAST_ADDR   28    /* 4 <ipaddr> */
+
+#define OPT_REQUESTED_IP     50    /* 4 <ipaddr> */
+#define OPT_LEASE_TIME       51    /* 4 <seconds> */
+#define OPT_MESSAGE_TYPE     53    /* 1 <msgtype> */
+#define OPT_SERVER_ID        54    /* 4 <ipaddr> */
+#define OPT_PARAMETER_LIST   55    /* n <optcode> * n */
+#define OPT_MESSAGE          56    /* n <errorstring> */
+#define OPT_CLASS_ID         60    /* n <opaque> */
+#define OPT_CLIENT_ID        61    /* n <opaque> */
+#define OPT_END              255
+
+/* DHCP message types */
+#define DHCPDISCOVER         1
+#define DHCPOFFER            2
+#define DHCPREQUEST          3
+#define DHCPDECLINE          4
+#define DHCPACK              5
+#define DHCPNAK              6
+#define DHCPRELEASE          7
+#define DHCPINFORM           8
+
+int init_dhcp_discover_msg(dhcp_msg *msg, void *hwaddr, uint32_t xid);
+
+int init_dhcp_request_msg(dhcp_msg *msg, void *hwaddr, uint32_t xid,
+                          uint32_t ipaddr, uint32_t serveraddr);
+
+#endif

root/package/link4all/quectel-CM/quectel1.6.0.15_src/libmnl/dhcp/packet.c

@@ -0,0 +1,247 @@
+/*
+ * Copyright 2008, The Android Open Source Project
+ *
+ * Licensed under the Apache License, Version 2.0 (the "License");
+ * you may not use this file except in compliance with the License.
+ * You may obtain a copy of the License at
+ *
+ *     http://www.apache.org/licenses/LICENSE-2.0
+ *
+ * Unless required by applicable law or agreed to in writing, software
+ * distributed under the License is distributed on an "AS IS" BASIS,
+ * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
+ * See the License for the specific language governing permissions and
+ * limitations under the License.
+ */
+
+#include <errno.h>
+#include <stdlib.h>
+#include <string.h>
+#include <sys/socket.h>
+#include <sys/uio.h>
+#include <linux/if_ether.h>
+#include <linux/if_packet.h>
+#include <netinet/in.h>
+#include <netinet/ip.h>
+#include <netinet/udp.h>
+#include <unistd.h>
+#include <stdio.h>
+
+#include "dhcpmsg.h"
+
+int fatal();
+
+int open_raw_socket(const char *ifname __attribute__((unused)), uint8_t *hwaddr, int if_index)
+{
+    int s;
+    struct sockaddr_ll bindaddr;
+
+    if((s = socket(PF_PACKET, SOCK_DGRAM, htons(ETH_P_IP))) < 0) {
+        return fatal("socket(PF_PACKET)");
+    }
+
+    memset(&bindaddr, 0, sizeof(bindaddr));
+    bindaddr.sll_family = AF_PACKET;
+    bindaddr.sll_protocol = htons(ETH_P_IP);
+    bindaddr.sll_halen = ETH_ALEN;
+    memcpy(bindaddr.sll_addr, hwaddr, ETH_ALEN);
+    bindaddr.sll_ifindex = if_index;
+
+    if (bind(s, (struct sockaddr *)&bindaddr, sizeof(bindaddr)) < 0) {
+        return fatal("Cannot bind raw socket to interface");
+    }
+
+    return s;
+}
+
+static uint32_t checksum(void *buffer, unsigned int count, uint32_t startsum)
+{
+    uint16_t *up = (uint16_t *)buffer;
+    uint32_t sum = startsum;
+    uint32_t upper16;
+
+    while (count > 1) {
+        sum += *up++;
+        count -= 2;
+    }
+    if (count > 0) {
+        sum += (uint16_t) *(uint8_t *)up;
+    }
+    while ((upper16 = (sum >> 16)) != 0) {
+        sum = (sum & 0xffff) + upper16;
+    }
+    return sum;
+}
+
+static uint32_t finish_sum(uint32_t sum)
+{
+    return ~sum & 0xffff;
+}
+
+int send_packet(int s, int if_index, struct dhcp_msg *msg, int size,
+                uint32_t saddr, uint32_t daddr, uint32_t sport, uint32_t dport)
+{
+    struct iphdr ip;
+    struct udphdr udp;
+    struct iovec iov[3];
+    uint32_t udpsum;
+    uint16_t temp;
+    struct msghdr msghdr;
+    struct sockaddr_ll destaddr;
+
+    ip.version = IPVERSION;
+    ip.ihl = sizeof(ip) >> 2;
+    ip.tos = 0;
+    ip.tot_len = htons(sizeof(ip) + sizeof(udp) + size);
+    ip.id = 0;
+    ip.frag_off = 0;
+    ip.ttl = IPDEFTTL;
+    ip.protocol = IPPROTO_UDP;
+    ip.check = 0;
+    ip.saddr = saddr;
+    ip.daddr = daddr;
+    ip.check = finish_sum(checksum(&ip, sizeof(ip), 0));
+
+    udp.source = htons(sport);
+    udp.dest = htons(dport);
+    udp.len = htons(sizeof(udp) + size);
+    udp.check = 0;
+
+    /* Calculate checksum for pseudo header */
+    udpsum = checksum(&ip.saddr, sizeof(ip.saddr), 0);
+    udpsum = checksum(&ip.daddr, sizeof(ip.daddr), udpsum);
+    temp = htons(IPPROTO_UDP);
+    udpsum = checksum(&temp, sizeof(temp), udpsum);
+    temp = udp.len;
+    udpsum = checksum(&temp, sizeof(temp), udpsum);
+
+    /* Add in the checksum for the udp header */
+    udpsum = checksum(&udp, sizeof(udp), udpsum);
+
+    /* Add in the checksum for the data */
+    udpsum = checksum(msg, size, udpsum);
+    udp.check = finish_sum(udpsum);
+
+    iov[0].iov_base = (char *)&ip;
+    iov[0].iov_len = sizeof(ip);
+    iov[1].iov_base = (char *)&udp;
+    iov[1].iov_len = sizeof(udp);
+    iov[2].iov_base = (char *)msg;
+    iov[2].iov_len = size;
+    memset(&destaddr, 0, sizeof(destaddr));
+    destaddr.sll_family = AF_PACKET;
+    destaddr.sll_protocol = htons(ETH_P_IP);
+    destaddr.sll_ifindex = if_index;
+    destaddr.sll_halen = ETH_ALEN;
+    memcpy(destaddr.sll_addr, "\xff\xff\xff\xff\xff\xff", ETH_ALEN);
+
+    msghdr.msg_name = &destaddr;
+    msghdr.msg_namelen = sizeof(destaddr);
+    msghdr.msg_iov = iov;
+    msghdr.msg_iovlen = sizeof(iov) / sizeof(struct iovec);
+    msghdr.msg_flags = 0;
+    msghdr.msg_control = 0;
+    msghdr.msg_controllen = 0;
+    return sendmsg(s, &msghdr, 0);
+}
+
+int receive_packet(int s, struct dhcp_msg *msg)
+{
+    int nread;
+    int is_valid;
+    struct dhcp_packet {
+        struct iphdr ip;
+        struct udphdr udp;
+        struct dhcp_msg dhcp;
+    } packet;
+    int dhcp_size;
+    uint32_t sum;
+    uint16_t temp;
+    uint32_t saddr, daddr;
+
+    nread = read(s, &packet, sizeof(packet));
+    if (nread < 0) {
+        return -1;
+    }
+    /*
+     * The raw packet interface gives us all packets received by the
+     * network interface. We need to filter out all packets that are
+     * not meant for us.
+     */
+    is_valid = 0;
+    if (nread < (int)(sizeof(struct iphdr) + sizeof(struct udphdr))) {
+#if VERBOSE
+        ALOGD("Packet is too small (%d) to be a UDP datagram", nread);
+#endif
+    } else if (packet.ip.version != IPVERSION || packet.ip.ihl != (sizeof(packet.ip) >> 2)) {
+#if VERBOSE
+        ALOGD("Not a valid IP packet");
+#endif
+    } else if (nread < ntohs(packet.ip.tot_len)) {
+#if VERBOSE
+        ALOGD("Packet was truncated (read %d, needed %d)", nread, ntohs(packet.ip.tot_len));
+#endif
+    } else if (packet.ip.protocol != IPPROTO_UDP) {
+#if VERBOSE
+        ALOGD("IP protocol (%d) is not UDP", packet.ip.protocol);
+#endif
+    } else if (packet.udp.dest != htons(PORT_BOOTP_CLIENT)) {
+#if VERBOSE
+        ALOGD("UDP dest port (%d) is not DHCP client", ntohs(packet.udp.dest));
+#endif
+    } else {
+        is_valid = 1;
+    }
+
+    if (!is_valid) {
+        return -1;
+    }
+
+    /* Seems like it's probably a valid DHCP packet */
+    /* validate IP header checksum */
+    sum = finish_sum(checksum(&packet.ip, sizeof(packet.ip), 0));
+    if (sum != 0) {
+        printf("IP header checksum failure (0x%x)\n", packet.ip.check);
+        return -1;
+    }
+    /*
+     * Validate the UDP checksum.
+     * Since we don't need the IP header anymore, we "borrow" it
+     * to construct the pseudo header used in the checksum calculation.
+     */
+    dhcp_size = ntohs(packet.udp.len) - sizeof(packet.udp);
+    /*
+     * check validity of dhcp_size.
+     * 1) cannot be negative or zero.
+     * 2) src buffer contains enough bytes to copy
+     * 3) cannot exceed destination buffer
+     */
+    if ((dhcp_size <= 0) ||
+        ((int)(nread - sizeof(struct iphdr) - sizeof(struct udphdr)) < dhcp_size) ||
+        ((int)sizeof(struct dhcp_msg) < dhcp_size)) {
+#if VERBOSE
+        printf("Malformed Packet\n");
+#endif
+        return -1;
+    }
+    saddr = packet.ip.saddr;
+    daddr = packet.ip.daddr;
+    nread = ntohs(packet.ip.tot_len);
+    memset(&packet.ip, 0, sizeof(packet.ip));
+    packet.ip.saddr = saddr;
+    packet.ip.daddr = daddr;
+    packet.ip.protocol = IPPROTO_UDP;
+    packet.ip.tot_len = packet.udp.len;
+    temp = packet.udp.check;
+    packet.udp.check = 0;
+    sum = finish_sum(checksum(&packet, nread, 0));
+    packet.udp.check = temp;
+    if (!sum)
+        sum = finish_sum(sum);
+    if (temp != sum) {
+        printf("UDP header checksum failure (0x%x should be 0x%x)\n", sum, temp);
+        return -1;
+    }
+    memcpy(msg, &packet.dhcp, dhcp_size);
+    return dhcp_size;
+}

root/package/link4all/quectel-CM/quectel1.6.0.15_src/libmnl/dhcp/packet.h

@@ -0,0 +1,25 @@
+/*
+ * Copyright 2008, The Android Open Source Project
+ *
+ * Licensed under the Apache License, Version 2.0 (the "License"); 
+ * you may not use this file except in compliance with the License. 
+ * You may obtain a copy of the License at 
+ *
+ *     http://www.apache.org/licenses/LICENSE-2.0 
+ *
+ * Unless required by applicable law or agreed to in writing, software 
+ * distributed under the License is distributed on an "AS IS" BASIS, 
+ * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. 
+ * See the License for the specific language governing permissions and 
+ * limitations under the License.
+ */
+
+#ifndef _WIFI_PACKET_H_
+#define _WIFI_PACKET_H_
+
+int open_raw_socket(const char *ifname, uint8_t *hwaddr, int if_index);
+int send_packet(int s, int if_index, struct dhcp_msg *msg, int size,
+                uint32_t saddr, uint32_t daddr, uint32_t sport, uint32_t dport);
+int receive_packet(int s, struct dhcp_msg *msg);
+
+#endif

root/package/link4all/quectel-CM/quectel1.6.0.15_src/libmnl/ifutils.c

@@ -0,0 +1,742 @@
+/* This example is placed in the public domain. */
+#include <netinet/in.h>
+#include <arpa/inet.h>
+#include <time.h>
+#include <errno.h>
+#include <stdio.h>
+#include <stdlib.h>
+#include <unistd.h>
+#include <strings.h>
+#include <net/if.h>
+#include <string.h>
+#include <sys/stat.h>
+#include <sys/fcntl.h>
+#include <sys/ioctl.h>
+
+#include <linux/if_link.h>
+#include <linux/if_ether.h>
+#include <linux/rtnetlink.h>
+#include <linux/if.h>
+
+#include "libmnl.h"
+#include "ifutils.h"
+
+#define ERRMSG(v...) printf("%s-%d: error=%s %s\n", __func__, __LINE__, strerror(errno), ##v)
+
+int mask_to_prefix_v4(uint32_t mask)
+{
+    int ret = 0;
+    while (mask)
+    {
+        mask = mask & (mask - 1);
+        ret++;
+    }
+    return ret;
+}
+
+const char *ipaddr_to_string_v4(in_addr_t ipaddr)
+{
+    static char buf[INET6_ADDRSTRLEN] = {'\0'};
+    buf[0] = '\0';
+    uint32_t addr = ipaddr;
+    return inet_ntop(AF_INET, &addr, buf, sizeof(buf));
+}
+
+const char *ipaddr_to_string_v6(uint8_t *ipaddr)
+{
+    static char buf[INET6_ADDRSTRLEN] = {'\0'};
+    buf[0] = '\0';
+    return inet_ntop(AF_INET6, ipaddr, buf, sizeof(buf));
+}
+
+static void ifc_init_ifr(const char *name, struct ifreq *ifr)
+{
+    memset(ifr, 0, sizeof(struct ifreq));
+    strncpy(ifr->ifr_name, name, IFNAMSIZ);
+    ifr->ifr_name[IFNAMSIZ - 1] = 0;
+}
+
+int if_get_hwaddr(const char *name, void *ptr)
+{
+    int r;
+    struct ifreq ifr;
+    ifc_init_ifr(name, &ifr);
+
+    int ifc_ctl_sock = socket(AF_INET, SOCK_DGRAM | SOCK_CLOEXEC, 0);
+    if (ifc_ctl_sock < 0)
+    {
+        return -1;
+    }
+    r = ioctl(ifc_ctl_sock, SIOCGIFHWADDR, &ifr);
+    if (r < 0)
+        return -1;
+
+    memcpy(ptr, &ifr.ifr_hwaddr.sa_data, ETH_ALEN);
+    return 0;
+}
+
+static int if_act_on_link(const char *ifname, int state)
+{
+    struct mnl_socket *nl;
+    char buf[MNL_SOCKET_BUFFER_SIZE];
+    struct nlmsghdr *nlh;
+    struct ifinfomsg *ifm;
+    int ret;
+    unsigned int seq, portid, change = 0, flags = 0;
+    static int oldstate = -1;
+
+    if (state == oldstate)
+        return 0;
+    oldstate = state;
+
+    if (state)
+    {
+        change |= IFF_UP;
+        flags |= IFF_UP;
+    }
+    else
+    {
+        change |= IFF_UP;
+        flags &= ~IFF_UP;
+    }
+
+    nlh = mnl_nlmsg_put_header(buf);
+    nlh->nlmsg_type = RTM_NEWLINK;
+    nlh->nlmsg_flags = NLM_F_REQUEST | NLM_F_ACK;
+    nlh->nlmsg_seq = seq = time(NULL);
+    ifm = mnl_nlmsg_put_extra_header(nlh, sizeof(*ifm));
+    ifm->ifi_family = AF_UNSPEC;
+    ifm->ifi_change = change;
+    ifm->ifi_flags = flags;
+
+    mnl_attr_put_str(nlh, IFLA_IFNAME, ifname);
+
+    nl = mnl_socket_open(NETLINK_ROUTE);
+    if (nl == NULL)
+    {
+        ERRMSG("mnl_socket_open");
+        return -1;
+    }
+
+    if (mnl_socket_bind(nl, 0, MNL_SOCKET_AUTOPID) < 0)
+    {
+        ERRMSG(" mnl_socket_bind");
+        return -1;
+    }
+    portid = mnl_socket_get_portid(nl);
+
+    if (mnl_socket_sendto(nl, nlh, nlh->nlmsg_len) < 0)
+    {
+        ERRMSG(" mnl_socket_sendto");
+        return -1;
+    }
+
+    ret = mnl_socket_recvfrom(nl, buf, sizeof(buf));
+    if (ret == -1)
+    {
+        ERRMSG(" mnl_socket_recvfrom");
+        return -1;
+    }
+
+    ret = mnl_cb_run(buf, ret, seq, portid, NULL, NULL);
+    if (ret == -1)
+    {
+        ERRMSG(" mnl_cb_run");
+        return -1;
+    }
+
+    mnl_socket_close(nl);
+
+    return 0;
+}
+
+int if_link_up(const char *ifname)
+{
+    return if_act_on_link(ifname, 1);
+}
+
+int if_link_down(const char *ifname)
+{
+    return if_act_on_link(ifname, 0);
+}
+
+int if_set_mtu(const char *ifname, uint32_t mtu)
+{
+    char buf[MNL_SOCKET_BUFFER_SIZE];
+    unsigned int seq, portid;
+    struct mnl_socket *nl;
+    struct nlmsghdr *nlh;
+    struct ifinfomsg *ifm;
+    int ret;
+    int iface;
+    static uint32_t oldmtu = 1500;
+
+    if (mtu == oldmtu)
+        return 0;
+    oldmtu = mtu;
+
+    iface = if_nametoindex(ifname);
+    if (iface == 0)
+    {
+        ERRMSG(" if_nametoindex");
+        return -1;
+    }
+
+    nlh = mnl_nlmsg_put_header(buf);
+    nlh->nlmsg_type = RTM_NEWLINK;
+    nlh->nlmsg_flags = NLM_F_REQUEST | NLM_F_ACK;
+    nlh->nlmsg_seq = seq = time(NULL);
+    ifm = mnl_nlmsg_put_extra_header(nlh, sizeof(struct ifinfomsg));
+    ifm->ifi_family = AF_UNSPEC;
+    ifm->ifi_index = iface;
+    ifm->ifi_change = 0xFFFFFFFF;
+    ifm->ifi_type = ifm->ifi_flags = 0;
+
+    mnl_attr_put_u32(nlh, IFLA_MTU, mtu);
+
+    nl = mnl_socket_open(NETLINK_ROUTE);
+    if (nl == NULL)
+    {
+        ERRMSG(" mnl_socket_open");
+        return -1;
+    }
+
+    if (mnl_socket_bind(nl, 0, MNL_SOCKET_AUTOPID) < 0)
+    {
+        ERRMSG(" mnl_socket_bind");
+        return -1;
+    }
+    portid = mnl_socket_get_portid(nl);
+
+    if (mnl_socket_sendto(nl, nlh, nlh->nlmsg_len) < 0)
+    {
+        ERRMSG(" mnl_socket_sendto");
+        return -1;
+    }
+
+    ret = mnl_socket_recvfrom(nl, buf, sizeof(buf));
+    if (ret == -1)
+    {
+        ERRMSG(" mnl_socket_recvfrom");
+        return -1;
+    }
+
+    ret = mnl_cb_run(buf, ret, seq, portid, NULL, NULL);
+    if (ret == -1)
+    {
+        ERRMSG(" mnl_cb_run");
+        return -1;
+    }
+
+    mnl_socket_close(nl);
+
+    return 0;
+}
+
+/**
+ * @brief Set the ip addr object
+ * 
+ * @param operate 
+ *  0 -> add address on interface
+ *  1 -> delete address on interface
+ * @param ifname 
+ * @param ipaddr 
+ * @param prefix 
+ * @return int 
+ */
+static int if_act_on_addr(bool operate, int proto, const char *ifname, addr_t *ipaddr, uint32_t prefix)
+{
+    struct mnl_socket *nl;
+    char buf[MNL_SOCKET_BUFFER_SIZE];
+    struct nlmsghdr *nlh;
+    struct ifaddrmsg *ifm;
+    uint32_t seq, portid;
+    int ret, family = proto;
+
+    int iface;
+
+    iface = if_nametoindex(ifname);
+    if (iface == 0)
+    {
+        ERRMSG(" if_nametoindex");
+        return -1;
+    }
+
+    nlh = mnl_nlmsg_put_header(buf);
+    if (operate)
+        nlh->nlmsg_type = RTM_NEWADDR;
+    else
+        nlh->nlmsg_type = RTM_DELADDR;
+
+    nlh->nlmsg_flags = NLM_F_REQUEST | NLM_F_CREATE | NLM_F_REPLACE | NLM_F_ACK;
+    nlh->nlmsg_seq = seq = time(NULL);
+
+    ifm = mnl_nlmsg_put_extra_header(nlh, sizeof(struct ifaddrmsg));
+
+    ifm->ifa_family = family;
+    ifm->ifa_prefixlen = prefix;
+    ifm->ifa_flags = IFA_F_PERMANENT;
+
+    ifm->ifa_scope = RT_SCOPE_UNIVERSE;
+    ifm->ifa_index = iface;
+
+    /*
+	 * The exact meaning of IFA_LOCAL and IFA_ADDRESS depend
+	 * on the address family being used and the device type.
+	 * For broadcast devices (like the interfaces we use),
+	 * for IPv4 we specify both and they are used interchangeably.
+	 * For IPv6, only IFA_ADDRESS needs to be set.
+	 */
+    if (family == AF_INET)
+    {
+        mnl_attr_put_u32(nlh, IFA_LOCAL, ipaddr->ip);
+        mnl_attr_put_u32(nlh, IFA_ADDRESS, ipaddr->ip);
+    }
+    else
+    {
+        mnl_attr_put(nlh, IFA_ADDRESS, sizeof(struct in6_addr), ipaddr);
+    }
+
+    nl = mnl_socket_open(NETLINK_ROUTE);
+    if (nl == NULL)
+    {
+        ERRMSG(" mnl_socket_open");
+        return -1;
+    }
+
+    if (mnl_socket_bind(nl, 0, MNL_SOCKET_AUTOPID) < 0)
+    {
+        ERRMSG(" mnl_socket_bind");
+        return -1;
+    }
+    portid = mnl_socket_get_portid(nl);
+
+    if (mnl_socket_sendto(nl, nlh, nlh->nlmsg_len) < 0)
+    {
+        ERRMSG(" mnl_socket_sendto");
+        return -1;
+    }
+
+    ret = mnl_socket_recvfrom(nl, buf, sizeof(buf));
+    if (ret < 0)
+    {
+        ERRMSG(" mnl_socket_recvfrom");
+        return -1;
+    }
+
+    ret = mnl_cb_run(buf, ret, seq, portid, NULL, NULL);
+    if (ret < 0)
+    {
+        ERRMSG(" mnl_cb_run");
+        return -1;
+    }
+
+    mnl_socket_close(nl);
+
+    return 0;
+}
+
+int if_set_addr_v4(const char *ifname, in_addr_t ipaddr, uint32_t prefix)
+{
+    addr_t addr;
+    addr.ip = ipaddr;
+    return if_act_on_addr(1, AF_INET, ifname, &addr, prefix);
+}
+
+int if_del_addr_v4(const char *ifname, in_addr_t ipaddr, uint32_t prefix)
+{
+    addr_t addr;
+    addr.ip = ipaddr;
+    return if_act_on_addr(0, AF_INET, ifname, &addr, prefix);
+}
+
+int if_set_addr_v6(const char *ifname, uint8_t *ipaddr, uint32_t prefix)
+{
+    addr_t addr;
+    memcpy(&addr.ip6, ipaddr, 16);
+    return if_act_on_addr(1, AF_INET6, ifname, &addr, prefix);
+}
+
+int if_del_addr_v6(const char *ifname, uint8_t *ipaddr, uint32_t prefix)
+{
+    addr_t addr;
+    memcpy(&addr.ip6, ipaddr, 16);
+    return if_act_on_addr(0, AF_INET6, ifname, &addr, prefix);
+}
+
+static int data_attr_cb(const struct nlattr *attr, void *data)
+{
+    const struct nlattr **tb = data;
+    int type = mnl_attr_get_type(attr);
+
+    /* skip unsupported attribute in user-space */
+    if (mnl_attr_type_valid(attr, IFA_MAX) < 0)
+        return MNL_CB_OK;
+
+    switch (type)
+    {
+    case IFA_ADDRESS:
+        if (mnl_attr_validate(attr, MNL_TYPE_BINARY) < 0)
+        {
+            ERRMSG(" mnl_attr_validate");
+            return MNL_CB_ERROR;
+        }
+        break;
+    }
+    tb[type] = attr;
+    return MNL_CB_OK;
+}
+
+static int data_cb(const struct nlmsghdr *nlh, void *data)
+{
+    struct nlattr *tb[IFA_MAX + 1] = {};
+    struct ifaddrmsg *ifa = mnl_nlmsg_get_payload(nlh);
+    struct addrinfo_t *addrinfo = (struct addrinfo_t *)data;
+    void *addr = NULL;
+
+    mnl_attr_parse(nlh, sizeof(*ifa), data_attr_cb, tb);
+    if (tb[IFA_ADDRESS])
+    {
+        char out[INET6_ADDRSTRLEN];
+
+        addr = mnl_attr_get_payload(tb[IFLA_ADDRESS]);
+        addr = mnl_attr_get_payload(tb[IFA_ADDRESS]);
+        if (!inet_ntop(ifa->ifa_family, addr, out, sizeof(out)))
+            ERRMSG("inet_ntop");
+        // printf("%d %d-> %d %s\n", addrinfo->iface, ifa->ifa_index, ifa->ifa_scope, out);
+
+        addrinfo->addrs[addrinfo->num].prefix = ifa->ifa_prefixlen;
+        if (ifa->ifa_index == addrinfo->iface)
+        {
+            if (ifa->ifa_family == AF_INET6)
+                memcpy(addrinfo->addrs[addrinfo->num].address.ip6.s6_addr, addr, 16);
+            if (ifa->ifa_family == AF_INET)
+                memcpy(&(addrinfo->addrs[addrinfo->num].address.ip), addr, 4);
+            addrinfo->num++;
+        }
+    }
+
+    // ifa->ifa_scope
+    // 0: global
+    // 200: site
+    // 253: link
+    // 254: host
+    // 255: nowhere
+
+    return MNL_CB_OK;
+}
+
+/**
+ * @brief 
+ * 
+ * @param ifname 
+ * @param proto
+ *  AF_INET -> for IPv4
+ *  AF_INET6 -> for IPv6
+ * @return int 
+ */
+static int if_get_addr(const char *ifname, int proto, struct addrinfo_t *addrinfo)
+{
+    char buf[MNL_SOCKET_BUFFER_SIZE];
+    unsigned int seq, portid;
+    struct mnl_socket *nl;
+    struct nlmsghdr *nlh;
+    struct rtgenmsg *rt;
+    int ret;
+
+    addrinfo->iface = if_nametoindex(ifname);
+    if (addrinfo->iface == 0)
+    {
+        ERRMSG(" if_nametoindex");
+        return -1;
+    }
+
+    nlh = mnl_nlmsg_put_header(buf);
+    nlh->nlmsg_type = RTM_GETADDR;
+    nlh->nlmsg_flags = NLM_F_REQUEST | NLM_F_DUMP;
+    nlh->nlmsg_seq = seq = time(NULL);
+    rt = mnl_nlmsg_put_extra_header(nlh, sizeof(struct rtgenmsg));
+    if (proto == AF_INET)
+        rt->rtgen_family = AF_INET;
+    else if (proto == AF_INET6)
+        rt->rtgen_family = AF_INET6;
+
+    nl = mnl_socket_open(NETLINK_ROUTE);
+    if (nl == NULL)
+    {
+        ERRMSG(" mnl_socket_open");
+        return -1;
+    }
+
+    if (mnl_socket_bind(nl, 0, MNL_SOCKET_AUTOPID) < 0)
+    {
+        ERRMSG(" mnl_socket_bind");
+        return -1;
+    }
+    portid = mnl_socket_get_portid(nl);
+
+    if (mnl_socket_sendto(nl, nlh, nlh->nlmsg_len) < 0)
+    {
+        ERRMSG(" mnl_socket_sendto");
+        return -1;
+    }
+
+    ret = mnl_socket_recvfrom(nl, buf, sizeof(buf));
+    while (ret > 0)
+    {
+        ret = mnl_cb_run(buf, ret, seq, portid, data_cb, addrinfo);
+        if (ret <= MNL_CB_STOP)
+            break;
+        ret = mnl_socket_recvfrom(nl, buf, sizeof(buf));
+    }
+    if (ret == -1)
+    {
+        ERRMSG(" error");
+        return -1;
+    }
+    mnl_socket_close(nl);
+
+    return 0;
+}
+
+int if_flush_v4_addr(const char *ifname)
+{
+    struct addrinfo_t addrinfo;
+    int i = 0;
+    
+    memset(&addrinfo, 0, sizeof(struct addrinfo_t));
+    if_get_addr(ifname, AF_INET, &addrinfo);
+    for (; i < addrinfo.num; i++)
+    {
+        // printf("remove address: %s\n", ipaddr_to_string_v4(addrinfo.addrs[i].address.ip));
+        if_del_addr_v4(ifname, addrinfo.addrs[i].address.ip, addrinfo.addrs[i].prefix);
+    }
+    return 0;
+}
+
+int if_flush_v6_addr(const char *ifname)
+{
+    struct addrinfo_t addrinfo;
+    int i = 0;
+    
+    memset(&addrinfo, 0, sizeof(struct addrinfo_t));
+    if_get_addr(ifname, AF_INET6, &addrinfo);
+    for (; i < addrinfo.num; i++)
+    {
+        // printf("remove address: %s\n", ipaddr_to_string_v6(addrinfo.addrs[i].address.ip6.s6_addr));
+        if_del_addr_v6(ifname, addrinfo.addrs[i].address.ip6.s6_addr, addrinfo.addrs[i].prefix);
+    }
+    return 0;
+}
+
+/**
+ * @brief Set the route addr object
+ *   Usage: 
+ *      iface destination cidr [gateway]
+ *   Example:
+ *      eth0 10.0.1.12 32 10.0.1.11
+ *      eth0 ffff::10.0.1.12 128 fdff::1
+ * @param operate
+ *  add or del
+ * @param ifname 
+ * @param dstaddr 
+ * @param prefix 
+ * @param gwaddr 
+ * @return int 
+ */
+int if_act_on_route(bool operate, int proto, const char *ifname, addr_t *dstaddr, uint32_t prefix, addr_t *gwaddr)
+{
+    struct mnl_socket *nl;
+    char buf[MNL_SOCKET_BUFFER_SIZE];
+    struct nlmsghdr *nlh;
+    struct rtmsg *rtm;
+    uint32_t seq, portid;
+    int iface, ret, family = proto;
+
+    iface = if_nametoindex(ifname);
+    if (iface == 0)
+    {
+        ERRMSG(" if_nametoindex");
+        return -1;
+    }
+
+    nlh = mnl_nlmsg_put_header(buf);
+    if (operate)
+        nlh->nlmsg_type = RTM_NEWROUTE;
+    else
+        nlh->nlmsg_type = RTM_DELROUTE;
+
+    nlh->nlmsg_flags = NLM_F_REQUEST | NLM_F_CREATE | NLM_F_ACK;
+    nlh->nlmsg_seq = seq = time(NULL);
+
+    rtm = mnl_nlmsg_put_extra_header(nlh, sizeof(struct rtmsg));
+    rtm->rtm_family = family;
+    rtm->rtm_dst_len = prefix;
+    rtm->rtm_src_len = 0;
+    rtm->rtm_tos = 0;
+    rtm->rtm_protocol = RTPROT_STATIC;
+    rtm->rtm_table = RT_TABLE_MAIN;
+    rtm->rtm_type = RTN_UNICAST;
+    /* is there any gateway? */
+    rtm->rtm_scope = gwaddr ? RT_SCOPE_UNIVERSE : RT_SCOPE_LINK;
+    rtm->rtm_flags = 0;
+
+    if (family == AF_INET)
+        mnl_attr_put_u32(nlh, RTA_DST, dstaddr->ip);
+    else
+        mnl_attr_put(nlh, RTA_DST, sizeof(struct in6_addr), dstaddr);
+
+    mnl_attr_put_u32(nlh, RTA_OIF, iface);
+    if (gwaddr)
+    {
+        if (family == AF_INET)
+            mnl_attr_put_u32(nlh, RTA_GATEWAY, gwaddr->ip);
+        else
+        {
+            mnl_attr_put(nlh, RTA_GATEWAY, sizeof(struct in6_addr), gwaddr);
+        }
+    }
+
+    nl = mnl_socket_open(NETLINK_ROUTE);
+    if (nl == NULL)
+    {
+        ERRMSG(" mnl_socket_open");
+        return -1;
+    }
+
+    if (mnl_socket_bind(nl, 0, MNL_SOCKET_AUTOPID) < 0)
+    {
+        ERRMSG(" mnl_socket_bind");
+        return -1;
+    }
+    portid = mnl_socket_get_portid(nl);
+
+    if (mnl_socket_sendto(nl, nlh, nlh->nlmsg_len) < 0)
+    {
+        ERRMSG(" mnl_socket_sendto");
+        return -1;
+    }
+
+    ret = mnl_socket_recvfrom(nl, buf, sizeof(buf));
+    if (ret < 0)
+    {
+        ERRMSG(" mnl_socket_recvfrom");
+        return -1;
+    }
+
+    ret = mnl_cb_run(buf, ret, seq, portid, NULL, NULL);
+    if (ret < 0)
+    {
+        ERRMSG(" mnl_cb_run");
+        return -1;
+    }
+
+    mnl_socket_close(nl);
+
+    return 0;
+}
+
+int if_set_default_route_v4(const char *ifname)
+{
+    return if_act_on_route(1, AF_INET, ifname, (addr_t *)&in6addr_any, 0, NULL);
+}
+
+int if_del_default_route_v4(const char *ifname)
+{
+    return if_act_on_route(0, AF_INET, ifname, (addr_t *)&in6addr_any, 0, NULL);
+}
+
+int if_set_default_route_v6(const char *ifname)
+{
+    return if_act_on_route(1, AF_INET6, ifname, (addr_t *)&in6addr_any, 0, NULL);
+}
+
+int if_del_default_route_v6(const char *ifname)
+{
+    return if_act_on_route(0, AF_INET6, ifname, (addr_t *)&in6addr_any, 0, NULL);
+}
+
+/**
+ * @brief Set the default gwaddr object
+ *  set default gw
+ * @param operate 
+ * @param ifname 
+ * @param gwaddr 
+ *  gateway ip
+ * @return int 
+ */
+int if_set_route_gw_v4(const char *ifname, in_addr_t gwaddr)
+{
+    addr_t addr;
+    memset(&addr, 0, sizeof(addr_t));
+    addr.ip = gwaddr;
+    return if_act_on_route(1, AF_INET, ifname, (addr_t *)&in6addr_any, 0, &addr);
+}
+
+int if_del_route_gw_v4(const char *ifname, in_addr_t gwaddr)
+{
+    addr_t addr;
+    memset(&addr, 0, sizeof(addr_t));
+    addr.ip = gwaddr;
+    return if_act_on_route(0, AF_INET, ifname, (addr_t *)&in6addr_any, 0, &addr);
+}
+
+int if_set_route_gw_v6(const char *ifname, uint8_t *gwaddr)
+{
+    addr_t addr;
+    memset(&addr, 0, sizeof(addr_t));
+    memcpy(&addr.ip6, gwaddr, 16);
+    return if_act_on_route(1, AF_INET6, ifname, (addr_t *)&in6addr_any, 0, &addr);
+}
+
+int if_del_route_gw_v6(const char *ifname, uint8_t *gwaddr)
+{
+    addr_t addr;
+    memset(&addr, 0, sizeof(addr_t));
+    memcpy(&addr.ip6, gwaddr, 16);
+    return if_act_on_route(0, AF_INET6, ifname, (addr_t *)&in6addr_any, 0, &addr);
+}
+
+int if_set_dns(const char *dns1, const char *dns2)
+{
+    int ret = 0;
+    char buf[128] = {'\0'};
+    int fd = open("/etc/resolv.conf", O_CREAT | O_WRONLY | O_TRUNC);
+    if (fd < 0)
+    {
+        ERRMSG(" fail to open /etc/resolv.conf");
+        return -1;
+    }
+
+    if (dns1)
+        snprintf(buf, sizeof(buf), "nameserver %s\n", dns1);
+    if (dns2)
+        snprintf(buf, sizeof(buf), "nameserver %s\n", dns2);
+    ret = write(fd, buf, strlen(buf));
+    if (ret < 0)
+    {
+        ERRMSG(" write dns");
+    }
+    close(fd);
+    return ret > 0 ? 0 : -1;
+}
+
+int if_set_network_v4(const char *ifname, in_addr_t ipaddr, uint32_t prefix,
+                      in_addr_t gwaddr, in_addr_t dns1, in_addr_t dns2)
+{
+    if_link_up(ifname);
+    if_set_addr_v4(ifname, ipaddr, prefix);
+    if_set_default_route_v4(ifname);
+    if_set_dns(ipaddr_to_string_v4(dns1), ipaddr_to_string_v4(dns2));
+    return 0;
+}
+
+int if_set_network_v6(const char *ifname, uint8_t *ipaddr, uint32_t prefix,
+                      uint8_t *gwaddr, uint8_t *dns1, uint8_t *dns2)
+{
+    if_link_up(ifname);
+    if_set_addr_v6(ifname, ipaddr, prefix);
+    if_set_default_route_v6(ifname);
+    if_set_dns(ipaddr_to_string_v6(dns1), ipaddr_to_string_v6(dns2));
+    return 0;
+}

root/package/link4all/quectel-CM/quectel1.6.0.15_src/libmnl/ifutils.h

@@ -0,0 +1,53 @@
+#ifndef __IFUTILS_H__
+#define __IFUTILS_H__
+
+typedef union {
+    in_addr_t ip;
+    struct in6_addr ip6;
+} addr_t;
+
+#define MAX_IP_NUM 32
+struct addrinfo_t
+{
+    int iface;
+    int num;
+    struct
+    {
+        int prefix;
+        addr_t address;
+    } addrs[MAX_IP_NUM];
+};
+
+const char *ipaddr_to_string_v4(in_addr_t ipaddr);
+const char *ipaddr_to_string_v6(uint8_t *ipaddr);
+int mask_to_prefix_v4(in_addr_t mask);
+
+int if_get_hwaddr(const char *name, void *ptr);
+
+int if_link_down(const char *ifname);
+int if_link_up(const char *ifname);
+int if_set_mtu(const char *ifname, uint32_t mtu);
+
+int if_set_addr_v4(const char *name, in_addr_t address, uint32_t prefixlen);
+int if_del_addr_v4(const char *name, in_addr_t address, uint32_t prefixlen);
+int if_set_addr_v6(const char *name, uint8_t *address, uint32_t prefixlen);
+int if_del_addr_v6(const char *name, uint8_t *address, uint32_t prefixlen);
+int if_flush_v4_addr(const char *ifname);
+int if_flush_v6_addr(const char *ifname);
+
+int if_set_route_gw_v4(const char *ifname, in_addr_t gwaddr);
+int if_del_route_gw_v4(const char *ifname, in_addr_t gwaddr);
+int if_set_default_route_v4(const char *ifname);
+int if_del_default_route_v4(const char *ifname);
+
+int if_set_route_gw_v6(const char *ifname, uint8_t *gwaddr);
+int if_del_route_gw_v6(const char *ifname, uint8_t *gwaddr);
+int if_set_default_route_v6(const char *ifname);
+int if_del_default_route_v6(const char *ifname);
+
+int if_set_network_v4(const char *ifname, in_addr_t ipaddr, uint32_t prefix,
+                      in_addr_t gwaddr, in_addr_t dns1, in_addr_t dns2);
+int if_set_network_v6(const char *ifname, uint8_t *ipaddr, uint32_t prefix,
+                      uint8_t *gwaddr, uint8_t *dns1, uint8_t *dns2);
+
+#endif //__IFUTILS_H__

root/package/link4all/quectel-CM/quectel1.6.0.15_src/libmnl/libmnl.h

@@ -0,0 +1,202 @@
+#ifndef _LIBMNL_H_
+#define _LIBMNL_H_
+
+#include <stdbool.h>
+#include <stdio.h>
+#include <stdint.h>
+#include <unistd.h>
+#include <sys/socket.h> /* for sa_family_t */
+#include <linux/netlink.h>
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+/*
+ * Netlink socket API
+ */
+
+#define MNL_SOCKET_AUTOPID	0
+#define MNL_SOCKET_BUFFER_SIZE (sysconf(_SC_PAGESIZE) < 8192L ? sysconf(_SC_PAGESIZE) : 8192L)
+#define MNL_SOCKET_DUMP_SIZE	32768
+
+struct mnl_socket;
+
+extern struct mnl_socket *mnl_socket_open(int bus);
+extern struct mnl_socket *mnl_socket_open2(int bus, int flags);
+extern struct mnl_socket *mnl_socket_fdopen(int fd);
+extern int mnl_socket_bind(struct mnl_socket *nl, unsigned int groups, pid_t pid);
+extern int mnl_socket_close(struct mnl_socket *nl);
+extern int mnl_socket_get_fd(const struct mnl_socket *nl);
+extern unsigned int mnl_socket_get_portid(const struct mnl_socket *nl);
+extern ssize_t mnl_socket_sendto(const struct mnl_socket *nl, const void *req, size_t siz);
+extern ssize_t mnl_socket_recvfrom(const struct mnl_socket *nl, void *buf, size_t siz);
+extern int mnl_socket_setsockopt(const struct mnl_socket *nl, int type, void *buf, socklen_t len);
+extern int mnl_socket_getsockopt(const struct mnl_socket *nl, int type, void *buf, socklen_t *len);
+
+/*
+ * Netlink message API
+ */
+
+#define MNL_ALIGNTO		4
+#define MNL_ALIGN(len)		(((len)+MNL_ALIGNTO-1) & ~(MNL_ALIGNTO-1))
+#define MNL_NLMSG_HDRLEN	MNL_ALIGN(sizeof(struct nlmsghdr))
+
+extern size_t mnl_nlmsg_size(size_t len);
+extern size_t mnl_nlmsg_get_payload_len(const struct nlmsghdr *nlh);
+
+/* Netlink message header builder */
+extern struct nlmsghdr *mnl_nlmsg_put_header(void *buf);
+extern void *mnl_nlmsg_put_extra_header(struct nlmsghdr *nlh, size_t size);
+
+/* Netlink message iterators */
+extern bool mnl_nlmsg_ok(const struct nlmsghdr *nlh, int len);
+extern struct nlmsghdr *mnl_nlmsg_next(const struct nlmsghdr *nlh, int *len);
+
+/* Netlink sequence tracking */
+extern bool mnl_nlmsg_seq_ok(const struct nlmsghdr *nlh, unsigned int seq);
+
+/* Netlink portID checking */
+extern bool mnl_nlmsg_portid_ok(const struct nlmsghdr *nlh, unsigned int portid);
+
+/* Netlink message getters */
+extern void *mnl_nlmsg_get_payload(const struct nlmsghdr *nlh);
+extern void *mnl_nlmsg_get_payload_offset(const struct nlmsghdr *nlh, size_t offset);
+extern void *mnl_nlmsg_get_payload_tail(const struct nlmsghdr *nlh);
+
+/* Netlink message printer */
+extern void mnl_nlmsg_fprintf(FILE *fd, const void *data, size_t datalen, size_t extra_header_size);
+
+/* Message batch helpers */
+struct mnl_nlmsg_batch;
+extern struct mnl_nlmsg_batch *mnl_nlmsg_batch_start(void *buf, size_t bufsiz);
+extern bool mnl_nlmsg_batch_next(struct mnl_nlmsg_batch *b);
+extern void mnl_nlmsg_batch_stop(struct mnl_nlmsg_batch *b);
+extern size_t mnl_nlmsg_batch_size(struct mnl_nlmsg_batch *b);
+extern void mnl_nlmsg_batch_reset(struct mnl_nlmsg_batch *b);
+extern void *mnl_nlmsg_batch_head(struct mnl_nlmsg_batch *b);
+extern void *mnl_nlmsg_batch_current(struct mnl_nlmsg_batch *b);
+extern bool mnl_nlmsg_batch_is_empty(struct mnl_nlmsg_batch *b);
+
+/*
+ * Netlink attributes API
+ */
+#define MNL_ATTR_HDRLEN	MNL_ALIGN(sizeof(struct nlattr))
+
+/* TLV attribute getters */
+extern uint16_t mnl_attr_get_type(const struct nlattr *attr);
+extern uint16_t mnl_attr_get_len(const struct nlattr *attr);
+extern uint16_t mnl_attr_get_payload_len(const struct nlattr *attr);
+extern void *mnl_attr_get_payload(const struct nlattr *attr);
+extern uint8_t mnl_attr_get_u8(const struct nlattr *attr);
+extern uint16_t mnl_attr_get_u16(const struct nlattr *attr);
+extern uint32_t mnl_attr_get_u32(const struct nlattr *attr);
+extern uint64_t mnl_attr_get_u64(const struct nlattr *attr);
+extern const char *mnl_attr_get_str(const struct nlattr *attr);
+
+/* TLV attribute putters */
+extern void mnl_attr_put(struct nlmsghdr *nlh, uint16_t type, size_t len, const void *data);
+extern void mnl_attr_put_u8(struct nlmsghdr *nlh, uint16_t type, uint8_t data);
+extern void mnl_attr_put_u16(struct nlmsghdr *nlh, uint16_t type, uint16_t data);
+extern void mnl_attr_put_u32(struct nlmsghdr *nlh, uint16_t type, uint32_t data);
+extern void mnl_attr_put_u64(struct nlmsghdr *nlh, uint16_t type, uint64_t data);
+extern void mnl_attr_put_str(struct nlmsghdr *nlh, uint16_t type, const char *data);
+extern void mnl_attr_put_strz(struct nlmsghdr *nlh, uint16_t type, const char *data);
+
+/* TLV attribute putters with buffer boundary checkings */
+extern bool mnl_attr_put_check(struct nlmsghdr *nlh, size_t buflen, uint16_t type, size_t len, const void *data);
+extern bool mnl_attr_put_u8_check(struct nlmsghdr *nlh, size_t buflen, uint16_t type, uint8_t data);
+extern bool mnl_attr_put_u16_check(struct nlmsghdr *nlh, size_t buflen, uint16_t type, uint16_t data);
+extern bool mnl_attr_put_u32_check(struct nlmsghdr *nlh, size_t buflen, uint16_t type, uint32_t data);
+extern bool mnl_attr_put_u64_check(struct nlmsghdr *nlh, size_t buflen, uint16_t type, uint64_t data);
+extern bool mnl_attr_put_str_check(struct nlmsghdr *nlh, size_t buflen, uint16_t type, const char *data);
+extern bool mnl_attr_put_strz_check(struct nlmsghdr *nlh, size_t buflen, uint16_t type, const char *data);
+
+/* TLV attribute nesting */
+extern struct nlattr *mnl_attr_nest_start(struct nlmsghdr *nlh, uint16_t type);
+extern struct nlattr *mnl_attr_nest_start_check(struct nlmsghdr *nlh, size_t buflen, uint16_t type);
+extern void mnl_attr_nest_end(struct nlmsghdr *nlh, struct nlattr *start);
+extern void mnl_attr_nest_cancel(struct nlmsghdr *nlh, struct nlattr *start);
+
+/* TLV validation */
+extern int mnl_attr_type_valid(const struct nlattr *attr, uint16_t maxtype);
+
+enum mnl_attr_data_type {
+	MNL_TYPE_UNSPEC,
+	MNL_TYPE_U8,
+	MNL_TYPE_U16,
+	MNL_TYPE_U32,
+	MNL_TYPE_U64,
+	MNL_TYPE_STRING,
+	MNL_TYPE_FLAG,
+	MNL_TYPE_MSECS,
+	MNL_TYPE_NESTED,
+	MNL_TYPE_NESTED_COMPAT,
+	MNL_TYPE_NUL_STRING,
+	MNL_TYPE_BINARY,
+	MNL_TYPE_MAX,
+};
+
+extern int mnl_attr_validate(const struct nlattr *attr, enum mnl_attr_data_type type);
+extern int mnl_attr_validate2(const struct nlattr *attr, enum mnl_attr_data_type type, size_t len);
+
+/* TLV iterators */
+extern bool mnl_attr_ok(const struct nlattr *attr, int len);
+extern struct nlattr *mnl_attr_next(const struct nlattr *attr);
+
+#define mnl_attr_for_each(attr, nlh, offset) \
+	for ((attr) = mnl_nlmsg_get_payload_offset((nlh), (offset)); \
+	     mnl_attr_ok((attr), (char *)mnl_nlmsg_get_payload_tail(nlh) - (char *)(attr)); \
+	     (attr) = mnl_attr_next(attr))
+
+#define mnl_attr_for_each_nested(attr, nest) \
+	for ((attr) = mnl_attr_get_payload(nest); \
+	     mnl_attr_ok((attr), (char *)mnl_attr_get_payload(nest) + mnl_attr_get_payload_len(nest) - (char *)(attr)); \
+	     (attr) = mnl_attr_next(attr))
+
+#define mnl_attr_for_each_payload(payload, payload_size) \
+	for ((attr) = (payload); \
+	     mnl_attr_ok((attr), (char *)(payload) + payload_size - (char *)(attr)); \
+	     (attr) = mnl_attr_next(attr))
+
+/* TLV callback-based attribute parsers */
+typedef int (*mnl_attr_cb_t)(const struct nlattr *attr, void *data);
+
+extern int mnl_attr_parse(const struct nlmsghdr *nlh, unsigned int offset, mnl_attr_cb_t cb, void *data);
+extern int mnl_attr_parse_nested(const struct nlattr *attr, mnl_attr_cb_t cb, void *data);
+extern int mnl_attr_parse_payload(const void *payload, size_t payload_len, mnl_attr_cb_t cb, void *data);
+
+/*
+ * callback API
+ */
+#define MNL_CB_ERROR		-1
+#define MNL_CB_STOP		 0
+#define MNL_CB_OK		 1
+
+typedef int (*mnl_cb_t)(const struct nlmsghdr *nlh, void *data);
+
+extern int mnl_cb_run(const void *buf, size_t numbytes, unsigned int seq,
+		      unsigned int portid, mnl_cb_t cb_data, void *data);
+
+extern int mnl_cb_run2(const void *buf, size_t numbytes, unsigned int seq,
+		       unsigned int portid, mnl_cb_t cb_data, void *data,
+		       const mnl_cb_t *cb_ctl_array,
+		       unsigned int cb_ctl_array_len);
+
+/*
+ * other declarations
+ */
+
+#ifndef SOL_NETLINK
+#define SOL_NETLINK	270
+#endif
+
+#ifndef MNL_ARRAY_SIZE
+#define MNL_ARRAY_SIZE(a) (sizeof(a)/sizeof((a)[0]))
+#endif
+
+#ifdef __cplusplus
+} /* extern "C" */
+#endif
+
+#endif

root/package/link4all/quectel-CM/quectel1.6.0.15_src/libmnl/nlmsg.c

@@ -0,0 +1,556 @@
+/*
+ * (C) 2008-2010 by Pablo Neira Ayuso <pablo@netfilter.org>
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU Lesser General Public License as published
+ * by the Free Software Foundation; either version 2.1 of the License, or
+ * (at your option) any later version.
+ */
+#include <stdbool.h>
+#include <stdio.h>
+#include <stdlib.h>
+#include <ctype.h>
+#include <errno.h>
+#include <string.h>
+
+#include "libmnl.h"
+
+/**
+ * \defgroup nlmsg Netlink message helpers
+ *
+ * Netlink message:
+ * \verbatim
+	|<----------------- 4 bytes ------------------->|
+	|<----- 2 bytes ------>|<------- 2 bytes ------>|
+	|-----------------------------------------------|
+	|      Message length (including header)        |
+	|-----------------------------------------------|
+	|     Message type     |     Message flags      |
+	|-----------------------------------------------|
+	|           Message sequence number             |
+	|-----------------------------------------------|
+	|                 Netlink PortID                |
+	|-----------------------------------------------|
+	|                                               |
+	.                   Payload                     .
+	|_______________________________________________|
+\endverbatim
+ *
+ * There is usually an extra header after the the Netlink header (at the
+ * beginning of the payload). This extra header is specific of the Netlink
+ * subsystem. After this extra header, it comes the sequence of attributes
+ * that are expressed in Type-Length-Value (TLV) format.
+ *
+ * @{
+ */
+
+/**
+ * mnl_nlmsg_size - calculate the size of Netlink message (without alignment)
+ * \param len length of the Netlink payload
+ *
+ * This function returns the size of a netlink message (header plus payload)
+ * without alignment.
+ */
+size_t mnl_nlmsg_size(size_t len)
+{
+	return len + MNL_NLMSG_HDRLEN;
+}
+
+/**
+ * mnl_nlmsg_get_payload_len - get the length of the Netlink payload
+ * \param nlh pointer to the header of the Netlink message
+ *
+ * This function returns the Length of the netlink payload, ie. the length
+ * of the full message minus the size of the Netlink header.
+ */
+size_t mnl_nlmsg_get_payload_len(const struct nlmsghdr *nlh)
+{
+	return nlh->nlmsg_len - MNL_NLMSG_HDRLEN;
+}
+
+/**
+ * mnl_nlmsg_put_header - reserve and prepare room for Netlink header
+ * \param buf memory already allocated to store the Netlink header
+ *
+ * This function sets to zero the room that is required to put the Netlink
+ * header in the memory buffer passed as parameter. This function also
+ * initializes the nlmsg_len field to the size of the Netlink header. This
+ * function returns a pointer to the Netlink header structure.
+ */
+struct nlmsghdr *mnl_nlmsg_put_header(void *buf)
+{
+	int len = MNL_ALIGN(sizeof(struct nlmsghdr));
+	struct nlmsghdr *nlh = buf;
+
+	memset(buf, 0, len);
+	nlh->nlmsg_len = len;
+	return nlh;
+}
+
+/**
+ * mnl_nlmsg_put_extra_header - reserve and prepare room for an extra header
+ * \param nlh pointer to Netlink header
+ * \param size size of the extra header that we want to put
+ *
+ * This function sets to zero the room that is required to put the extra
+ * header after the initial Netlink header. This function also increases
+ * the nlmsg_len field. You have to invoke mnl_nlmsg_put_header() before
+ * you call this function. This function returns a pointer to the extra
+ * header.
+ */
+void *mnl_nlmsg_put_extra_header(struct nlmsghdr *nlh,
+					       size_t size)
+{
+	char *ptr = (char *)nlh + nlh->nlmsg_len;
+	size_t len = MNL_ALIGN(size);
+	nlh->nlmsg_len += len;
+	memset(ptr, 0, len);
+	return ptr;
+}
+
+/**
+ * mnl_nlmsg_get_payload - get a pointer to the payload of the netlink message
+ * \param nlh pointer to a netlink header
+ *
+ * This function returns a pointer to the payload of the netlink message.
+ */
+void *mnl_nlmsg_get_payload(const struct nlmsghdr *nlh)
+{
+	return (void *)nlh + MNL_NLMSG_HDRLEN;
+}
+
+/**
+ * mnl_nlmsg_get_payload_offset - get a pointer to the payload of the message
+ * \param nlh pointer to a netlink header
+ * \param offset offset to the payload of the attributes TLV set
+ *
+ * This function returns a pointer to the payload of the netlink message plus
+ * a given offset.
+ */
+void *mnl_nlmsg_get_payload_offset(const struct nlmsghdr *nlh,
+						 size_t offset)
+{
+	return (void *)nlh + MNL_NLMSG_HDRLEN + MNL_ALIGN(offset);
+}
+
+/**
+ * mnl_nlmsg_ok - check a there is room for netlink message
+ * \param nlh netlink message that we want to check
+ * \param len remaining bytes in a buffer that contains the netlink message
+ *
+ * This function is used to check that a buffer that contains a netlink
+ * message has enough room for the netlink message that it stores, ie. this
+ * function can be used to verify that a netlink message is not malformed nor
+ * truncated.
+ *
+ * This function does not set errno in case of error since it is intended
+ * for iterations. Thus, it returns true on success and false on error.
+ *
+ * The len parameter may become negative in malformed messages during message
+ * iteration, that is why we use a signed integer.
+ */
+bool mnl_nlmsg_ok(const struct nlmsghdr *nlh, int len)
+{
+	return len >= (int)sizeof(struct nlmsghdr) &&
+	       nlh->nlmsg_len >= sizeof(struct nlmsghdr) &&
+	       (int)nlh->nlmsg_len <= len;
+}
+
+/**
+ * mnl_nlmsg_next - get the next netlink message in a multipart message
+ * \param nlh current netlink message that we are handling
+ * \param len length of the remaining bytes in the buffer (passed by reference).
+ *
+ * This function returns a pointer to the next netlink message that is part
+ * of a multi-part netlink message. Netlink can batch several messages into
+ * one buffer so that the receiver has to iterate over the whole set of
+ * Netlink messages.
+ *
+ * You have to use mnl_nlmsg_ok() to check if the next Netlink message is
+ * valid.
+ */
+struct nlmsghdr *mnl_nlmsg_next(const struct nlmsghdr *nlh,
+					      int *len)
+{
+	*len -= MNL_ALIGN(nlh->nlmsg_len);
+	return (struct nlmsghdr *)((void *)nlh + MNL_ALIGN(nlh->nlmsg_len));
+}
+
+/**
+ * mnl_nlmsg_get_payload_tail - get the ending of the netlink message
+ * \param nlh pointer to netlink message
+ *
+ * This function returns a pointer to the netlink message tail. This is useful
+ * to build a message since we continue adding attributes at the end of the
+ * message.
+ */
+void *mnl_nlmsg_get_payload_tail(const struct nlmsghdr *nlh)
+{
+	return (void *)nlh + MNL_ALIGN(nlh->nlmsg_len);
+}
+
+/**
+ * mnl_nlmsg_seq_ok - perform sequence tracking
+ * \param nlh current netlink message that we are handling
+ * \param seq last sequence number used to send a message
+ *
+ * This functions returns true if the sequence tracking is fulfilled, otherwise
+ * false is returned. We skip the tracking for netlink messages whose sequence
+ * number is zero since it is usually reserved for event-based kernel
+ * notifications. On the other hand, if seq is set but the message sequence
+ * number is not set (i.e. this is an event message coming from kernel-space),
+ * then we also skip the tracking. This approach is good if we use the same
+ * socket to send commands to kernel-space (that we want to track) and to
+ * listen to events (that we do not track).
+ */
+bool mnl_nlmsg_seq_ok(const struct nlmsghdr *nlh,
+				    unsigned int seq)
+{
+	return nlh->nlmsg_seq && seq ? nlh->nlmsg_seq == seq : true;
+}
+
+/**
+ * mnl_nlmsg_portid_ok - perform portID origin check
+ * \param nlh current netlink message that we are handling
+ * \param portid netlink portid that we want to check
+ *
+ * This functions returns true if the origin is fulfilled, otherwise
+ * false is returned. We skip the tracking for netlink message whose portID
+ * is zero since it is reserved for event-based kernel notifications. On the
+ * other hand, if portid is set but the message PortID is not (i.e. this
+ * is an event message coming from kernel-space), then we also skip the
+ * tracking. This approach is good if we use the same socket to send commands
+ * to kernel-space (that we want to track) and to listen to events (that we
+ * do not track).
+ */
+bool mnl_nlmsg_portid_ok(const struct nlmsghdr *nlh,
+				       unsigned int portid)
+{
+	return nlh->nlmsg_pid && portid ? nlh->nlmsg_pid == portid : true;
+}
+
+static void mnl_nlmsg_fprintf_header(FILE *fd, const struct nlmsghdr *nlh)
+{
+	fprintf(fd, "----------------\t------------------\n");
+	fprintf(fd, "|  %.010u  |\t| message length |\n", nlh->nlmsg_len);
+	fprintf(fd, "| %.05u | %c%c%c%c |\t|  type | flags  |\n",
+		nlh->nlmsg_type,
+		nlh->nlmsg_flags & NLM_F_REQUEST ? 'R' : '-',
+		nlh->nlmsg_flags & NLM_F_MULTI ? 'M' : '-',
+		nlh->nlmsg_flags & NLM_F_ACK ? 'A' : '-',
+		nlh->nlmsg_flags & NLM_F_ECHO ? 'E' : '-');
+	fprintf(fd, "|  %.010u  |\t| sequence number|\n", nlh->nlmsg_seq);
+	fprintf(fd, "|  %.010u  |\t|     port ID    |\n", nlh->nlmsg_pid);
+	fprintf(fd, "----------------\t------------------\n");
+}
+
+static void mnl_nlmsg_fprintf_payload(FILE *fd, const struct nlmsghdr *nlh,
+				      size_t extra_header_size)
+{
+	int rem = 0;
+	unsigned int i;
+
+	for (i=sizeof(struct nlmsghdr); i<nlh->nlmsg_len; i+=4) {
+		char *b = (char *) nlh;
+		struct nlattr *attr = (struct nlattr *) (b+i);
+
+		/* netlink control message. */
+		if (nlh->nlmsg_type < NLMSG_MIN_TYPE) {
+			fprintf(fd, "| %.2x %.2x %.2x %.2x  |\t",
+				0xff & b[i],	0xff & b[i+1],
+				0xff & b[i+2],	0xff & b[i+3]);
+			fprintf(fd, "|                |\n");
+		/* special handling for the extra header. */
+		} else if (extra_header_size > 0) {
+			extra_header_size -= 4;
+			fprintf(fd, "| %.2x %.2x %.2x %.2x  |\t",
+				0xff & b[i],	0xff & b[i+1],
+				0xff & b[i+2],	0xff & b[i+3]);
+			fprintf(fd, "|  extra header  |\n");
+		/* this seems like an attribute header. */
+		} else if (rem == 0 && (attr->nla_type & NLA_TYPE_MASK) != 0) {
+			fprintf(fd, "|%c[%d;%dm"
+				    "%.5u"
+				    "%c[%dm"
+				    "|"
+				    "%c[%d;%dm"
+				    "%c%c"
+				    "%c[%dm"
+				    "|"
+				    "%c[%d;%dm"
+				    "%.5u"
+				    "%c[%dm|\t",
+				27, 1, 31,
+				attr->nla_len,
+				27, 0,
+				27, 1, 32,
+				attr->nla_type & NLA_F_NESTED ? 'N' : '-',
+				attr->nla_type &
+					NLA_F_NET_BYTEORDER ? 'B' : '-',
+				27, 0,
+				27, 1, 34,
+				attr->nla_type & NLA_TYPE_MASK,
+				27, 0);
+			fprintf(fd, "|len |flags| type|\n");
+
+			if (!(attr->nla_type & NLA_F_NESTED)) {
+				rem = NLA_ALIGN(attr->nla_len) -
+					sizeof(struct nlattr);
+			}
+		/* this is the attribute payload. */
+		} else if (rem > 0) {
+			rem -= 4;
+			fprintf(fd, "| %.2x %.2x %.2x %.2x  |\t",
+				0xff & b[i],	0xff & b[i+1],
+				0xff & b[i+2],	0xff & b[i+3]);
+			fprintf(fd, "|      data      |");
+			fprintf(fd, "\t %c %c %c %c\n",
+				isprint(b[i]) ? b[i] : ' ',
+				isprint(b[i+1]) ? b[i+1] : ' ',
+				isprint(b[i+2]) ? b[i+2] : ' ',
+				isprint(b[i+3]) ? b[i+3] : ' ');
+		}
+	}
+	fprintf(fd, "----------------\t------------------\n");
+}
+
+/**
+ * mnl_nlmsg_fprintf - print netlink message to file
+ * \param fd pointer to file type
+ * \param data pointer to the buffer that contains messages to be printed
+ * \param datalen length of data stored in the buffer
+ * \param extra_header_size size of the extra header (if any)
+ *
+ * This function prints the netlink header to a file handle.
+ * It may be useful for debugging purposes. One example of the output
+ * is the following:
+ *
+ *\verbatim
+----------------        ------------------
+|  0000000040  |        | message length |
+| 00016 | R-A- |        |  type | flags  |
+|  1289148991  |        | sequence number|
+|  0000000000  |        |     port ID    |
+----------------        ------------------
+| 00 00 00 00  |        |  extra header  |
+| 00 00 00 00  |        |  extra header  |
+| 01 00 00 00  |        |  extra header  |
+| 01 00 00 00  |        |  extra header  |
+|00008|--|00003|        |len |flags| type|
+| 65 74 68 30  |        |      data      |       e t h 0
+----------------        ------------------
+\endverbatim
+ *
+ * This example above shows the netlink message that is send to kernel-space
+ * to set up the link interface eth0. The netlink and attribute header data
+ * are displayed in base 10 whereas the extra header and the attribute payload
+ * are expressed in base 16. The possible flags in the netlink header are:
+ *
+ * - R, that indicates that NLM_F_REQUEST is set.
+ * - M, that indicates that NLM_F_MULTI is set.
+ * - A, that indicates that NLM_F_ACK is set.
+ * - E, that indicates that NLM_F_ECHO is set.
+ *
+ * The lack of one flag is displayed with '-'. On the other hand, the possible
+ * attribute flags available are:
+ *
+ * - N, that indicates that NLA_F_NESTED is set.
+ * - B, that indicates that NLA_F_NET_BYTEORDER is set.
+ */
+void mnl_nlmsg_fprintf(FILE *fd, const void *data, size_t datalen,
+				     size_t extra_header_size)
+{
+	const struct nlmsghdr *nlh = data;
+	int len = datalen;
+
+	while (mnl_nlmsg_ok(nlh, len)) {
+		mnl_nlmsg_fprintf_header(fd, nlh);
+		mnl_nlmsg_fprintf_payload(fd, nlh, extra_header_size);
+		nlh = mnl_nlmsg_next(nlh, &len);
+	}
+}
+
+/**
+ * @}
+ */
+
+/**
+ * \defgroup batch Netlink message batch helpers
+ *
+ * This library provides helpers to batch several messages into one single
+ * datagram. These helpers do not perform strict memory boundary checkings.
+ *
+ * The following figure represents a Netlink message batch:
+ *
+ *   |<-------------- MNL_SOCKET_BUFFER_SIZE ------------->|
+ *   |<-------------------- batch ------------------>|     |
+ *   |-----------|-----------|-----------|-----------|-----------|
+ *   |<- nlmsg ->|<- nlmsg ->|<- nlmsg ->|<- nlmsg ->|<- nlmsg ->|
+ *   |-----------|-----------|-----------|-----------|-----------|
+ *                                             ^           ^
+ *                                             |           |
+ *                                        message N   message N+1
+ *
+ * To start the batch, you have to call mnl_nlmsg_batch_start() and you can
+ * use mnl_nlmsg_batch_stop() to release it.
+ *
+ * You have to invoke mnl_nlmsg_batch_next() to get room for a new message
+ * in the batch. If this function returns NULL, it means that the last
+ * message that was added (message N+1 in the figure above) does not fit the
+ * batch. Thus, you have to send the batch (which includes until message N)
+ * and, then, you have to call mnl_nlmsg_batch_reset() to re-initialize
+ * the batch (this moves message N+1 to the head of the buffer). For that
+ * reason, the buffer that you have to use to store the batch must be double
+ * of MNL_SOCKET_BUFFER_SIZE to ensure that the last message (message N+1)
+ * that did not fit into the batch is written inside valid memory boundaries.
+ *
+ * @{
+ */
+
+struct mnl_nlmsg_batch {
+	/* the buffer that is used to store the batch. */
+	void *buf;
+	size_t limit;
+	size_t buflen;
+	/* the current netlink message in the batch. */
+	void *cur;
+	bool overflow;
+};
+
+/**
+ * mnl_nlmsg_batch_start - initialize a batch
+ * \param buf pointer to the buffer that will store this batch
+ * \param limit maximum size of the batch (should be MNL_SOCKET_BUFFER_SIZE).
+ *
+ * The buffer that you pass must be double of MNL_SOCKET_BUFFER_SIZE. The
+ * limit must be half of the buffer size, otherwise expect funny memory
+ * corruptions 8-).
+ *
+ * You can allocate the buffer that you use to store the batch in the stack or
+ * the heap, no restrictions in this regard. This function returns NULL on
+ * error.
+ */
+struct mnl_nlmsg_batch *mnl_nlmsg_batch_start(void *buf,
+							    size_t limit)
+{
+	struct mnl_nlmsg_batch *b;
+
+	b = malloc(sizeof(struct mnl_nlmsg_batch));
+	if (b == NULL)
+		return NULL;
+
+	b->buf = buf;
+	b->limit = limit;
+	b->buflen = 0;
+	b->cur = buf;
+	b->overflow = false;
+
+	return b;
+}
+
+/**
+ * mnl_nlmsg_batch_stop - release a batch
+ * \param b pointer to batch
+ *
+ * This function releases the batch allocated by mnl_nlmsg_batch_start().
+ */
+void mnl_nlmsg_batch_stop(struct mnl_nlmsg_batch *b)
+{
+	free(b);
+}
+
+/**
+ * mnl_nlmsg_batch_next - get room for the next message in the batch
+ * \param b pointer to batch
+ *
+ * This function returns false if the last message did not fit into the
+ * batch. Otherwise, it prepares the batch to provide room for the new
+ * Netlink message in the batch and returns true.
+ *
+ * You have to put at least one message in the batch before calling this
+ * function, otherwise your application is likely to crash.
+ */
+bool mnl_nlmsg_batch_next(struct mnl_nlmsg_batch *b)
+{
+	struct nlmsghdr *nlh = b->cur;
+
+	if (b->buflen + nlh->nlmsg_len > b->limit) {
+		b->overflow = true;
+		return false;
+	}
+	b->cur = b->buf + b->buflen + nlh->nlmsg_len;
+	b->buflen += nlh->nlmsg_len;
+	return true;
+}
+
+/**
+ * mnl_nlmsg_batch_reset - reset the batch
+ * \param b pointer to batch
+ *
+ * This function allows to reset a batch, so you can reuse it to create a
+ * new one. This function moves the last message which does not fit the
+ * batch to the head of the buffer, if any.
+ */
+void mnl_nlmsg_batch_reset(struct mnl_nlmsg_batch *b)
+{
+	if (b->overflow) {
+		struct nlmsghdr *nlh = b->cur;
+		memcpy(b->buf, b->cur, nlh->nlmsg_len);
+		b->buflen = nlh->nlmsg_len;
+		b->cur = b->buf + b->buflen;
+		b->overflow = false;
+	} else {
+		b->buflen = 0;
+		b->cur = b->buf;
+	}
+}
+
+/**
+ * mnl_nlmsg_batch_size - get current size of the batch
+ * \param b pointer to batch
+ *
+ * This function returns the current size of the batch.
+ */
+size_t mnl_nlmsg_batch_size(struct mnl_nlmsg_batch *b)
+{
+	return b->buflen;
+}
+
+/**
+ * mnl_nlmsg_batch_head - get head of this batch
+ * \param b pointer to batch
+ *
+ * This function returns a pointer to the head of the batch, which is the
+ * beginning of the buffer that is used.
+ */
+void *mnl_nlmsg_batch_head(struct mnl_nlmsg_batch *b)
+{
+	return b->buf;
+}
+
+/**
+ * mnl_nlmsg_batch_current - returns current position in the batch
+ * \param b pointer to batch
+ *
+ * This function returns a pointer to the current position in the buffer
+ * that is used to store the batch.
+ */
+void *mnl_nlmsg_batch_current(struct mnl_nlmsg_batch *b)
+{
+	return b->cur;
+}
+
+/**
+ * mnl_nlmsg_batch_is_empty - check if there is any message in the batch
+ * \param b pointer to batch
+ *
+ * This function returns true if the batch is empty.
+ */
+bool mnl_nlmsg_batch_is_empty(struct mnl_nlmsg_batch *b)
+{
+	return b->buflen == 0;
+}
+
+/**
+ * @}
+ */

root/package/link4all/quectel-CM/quectel1.6.0.15_src/libmnl/socket.c

@@ -0,0 +1,351 @@
+/*
+ * (C) 2008-2010 by Pablo Neira Ayuso <pablo@netfilter.org>
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU Lesser General Public License as published
+ * by the Free Software Foundation; either version 2.1 of the License, or
+ * (at your option) any later version.
+ */
+
+#include <sys/types.h>
+#include <sys/socket.h>
+#include <stdlib.h>
+#include <unistd.h>
+#include <time.h>
+#include <errno.h>
+
+#include "libmnl.h"
+
+/**
+ * \mainpage
+ *
+ * libmnl is a minimalistic user-space library oriented to Netlink developers.
+ * There are a lot of common tasks in parsing, validating, constructing of
+ * both the Netlink header and TLVs that are repetitive and easy to get wrong.
+ * This library aims to provide simple helpers that allows you to avoid
+ * re-inventing the wheel in common Netlink tasks.
+ *
+ * \verbatim
+"Simplify, simplify" -- Henry David Thoureau. Walden (1854)
+\endverbatim
+ *
+ * The acronym libmnl stands for LIBrary Minimalistic NetLink.
+ *
+ * libmnl homepage is:
+ *      http://www.netfilter.org/projects/libmnl/
+ *
+ * \section features Main Features
+ * - Small: the shared library requires around 30KB for an x86-based computer.
+ * - Simple: this library avoids complex abstractions that tend to hide Netlink
+ *   details. It avoids elaborated object-oriented infrastructure and complex
+ *   callback-based workflow.
+ * - Easy to use: the library simplifies the work for Netlink-wise developers.
+ *   It provides functions to make socket handling, message building,
+ *   validating, parsing and sequence tracking, easier.
+ * - Easy to re-use: you can use this library to build your own abstraction
+ *   layer upon this library, if you want to provide another library that
+ *   hides Netlink details to your users.
+ * - Decoupling: the interdependency of the main bricks that compose this
+ *   library is reduced, i.e. the library provides many helpers, but the
+ *   programmer is not forced to use them.
+ *
+ * \section licensing Licensing terms
+ * This library is released under the LGPLv2.1 or any later (at your option).
+ *
+ * \section Dependencies
+ * You have to install the Linux kernel headers that you want to use to develop
+ * your application. Moreover, this library requires that you have some basics
+ * on Netlink.
+ *
+ * \section scm Git Tree
+ * The current development version of libmnl can be accessed at:
+ * http://git.netfilter.org/cgi-bin/gitweb.cgi?p=libmnl.git;a=summary
+ *
+ * \section using Using libmnl
+ * You can access several example files under examples/ in the libmnl source
+ * code tree.
+ */
+
+struct mnl_socket {
+	int 			fd;
+	struct sockaddr_nl	addr;
+};
+
+/**
+ * \defgroup socket Netlink socket helpers
+ * @{
+ */
+
+/**
+ * mnl_socket_get_fd - obtain file descriptor from netlink socket
+ * \param nl netlink socket obtained via mnl_socket_open()
+ *
+ * This function returns the file descriptor of a given netlink socket.
+ */
+int mnl_socket_get_fd(const struct mnl_socket *nl)
+{
+	return nl->fd;
+}
+
+/**
+ * mnl_socket_get_portid - obtain Netlink PortID from netlink socket
+ * \param nl netlink socket obtained via mnl_socket_open()
+ *
+ * This function returns the Netlink PortID of a given netlink socket.
+ * It's a common mistake to assume that this PortID equals the process ID
+ * which is not always true. This is the case if you open more than one
+ * socket that is binded to the same Netlink subsystem from the same process.
+ */
+unsigned int mnl_socket_get_portid(const struct mnl_socket *nl)
+{
+	return nl->addr.nl_pid;
+}
+
+static struct mnl_socket *__mnl_socket_open(int bus, int flags)
+{
+	struct mnl_socket *nl;
+
+	nl = calloc(1, sizeof(struct mnl_socket));
+	if (nl == NULL)
+		return NULL;
+
+	nl->fd = socket(AF_NETLINK, SOCK_RAW | flags, bus);
+	if (nl->fd == -1) {
+		free(nl);
+		return NULL;
+	}
+
+	return nl;
+}
+
+/**
+ * mnl_socket_open - open a netlink socket
+ * \param bus the netlink socket bus ID (see NETLINK_* constants)
+ *
+ * On error, it returns NULL and errno is appropriately set. Otherwise, it
+ * returns a valid pointer to the mnl_socket structure.
+ */
+struct mnl_socket *mnl_socket_open(int bus)
+{
+	return __mnl_socket_open(bus, 0);
+}
+
+/**
+ * mnl_socket_open2 - open a netlink socket with appropriate flags
+ * \param bus the netlink socket bus ID (see NETLINK_* constants)
+ * \param flags the netlink socket flags (see SOCK_* constants in socket(2))
+ *
+ * This is similar to mnl_socket_open(), but allows to set flags like
+ * SOCK_CLOEXEC at socket creation time (useful for multi-threaded programs
+ * performing exec calls).
+ *
+ * On error, it returns NULL and errno is appropriately set. Otherwise, it
+ * returns a valid pointer to the mnl_socket structure.
+ */
+struct mnl_socket *mnl_socket_open2(int bus, int flags)
+{
+	return __mnl_socket_open(bus, flags);
+}
+
+/**
+ * mnl_socket_fdopen - associates a mnl_socket object with pre-existing socket.
+ * \param fd pre-existing socket descriptor.
+ *
+ * On error, it returns NULL and errno is appropriately set. Otherwise, it
+ * returns a valid pointer to the mnl_socket structure. It also sets the portID
+ * if the socket fd is already bound and it is AF_NETLINK.
+ *
+ * Note that mnl_socket_get_portid() returns 0 if this function is used with
+ * non-netlink socket.
+ */
+struct mnl_socket *mnl_socket_fdopen(int fd)
+{
+	int ret;
+	struct mnl_socket *nl;
+	struct sockaddr_nl addr;
+	socklen_t addr_len = sizeof(struct sockaddr_nl);
+
+	ret = getsockname(fd, (struct sockaddr *) &addr, &addr_len);
+	if (ret == -1)
+		return NULL;
+
+	nl = calloc(1, sizeof(struct mnl_socket));
+	if (nl == NULL)
+		return NULL;
+
+	nl->fd = fd;
+	if (addr.nl_family == AF_NETLINK)
+		nl->addr = addr;
+
+	return nl;
+}
+
+/**
+ * mnl_socket_bind - bind netlink socket
+ * \param nl netlink socket obtained via mnl_socket_open()
+ * \param groups the group of message you're interested in
+ * \param pid the port ID you want to use (use zero for automatic selection)
+ *
+ * On error, this function returns -1 and errno is appropriately set. On
+ * success, 0 is returned. You can use MNL_SOCKET_AUTOPID which is 0 for
+ * automatic port ID selection.
+ */
+int mnl_socket_bind(struct mnl_socket *nl, unsigned int groups,
+				  pid_t pid)
+{
+	int ret;
+	socklen_t addr_len;
+
+	nl->addr.nl_family = AF_NETLINK;
+	nl->addr.nl_groups = groups;
+	nl->addr.nl_pid = pid;
+
+	ret = bind(nl->fd, (struct sockaddr *) &nl->addr, sizeof (nl->addr));
+	if (ret < 0)
+		return ret;
+
+	addr_len = sizeof(nl->addr);
+	ret = getsockname(nl->fd, (struct sockaddr *) &nl->addr, &addr_len);
+	if (ret < 0)	
+		return ret;
+
+	if (addr_len != sizeof(nl->addr)) {
+		errno = EINVAL;
+		return -1;
+	}
+	if (nl->addr.nl_family != AF_NETLINK) {
+		errno = EINVAL;
+		return -1;
+	}
+	return 0;
+}
+
+/**
+ * mnl_socket_sendto - send a netlink message of a certain size
+ * \param nl netlink socket obtained via mnl_socket_open()
+ * \param buf buffer containing the netlink message to be sent
+ * \param len number of bytes in the buffer that you want to send
+ *
+ * On error, it returns -1 and errno is appropriately set. Otherwise, it 
+ * returns the number of bytes sent.
+ */
+ssize_t mnl_socket_sendto(const struct mnl_socket *nl,
+					const void *buf, size_t len)
+{
+	static const struct sockaddr_nl snl = {
+		.nl_family = AF_NETLINK
+	};
+	return sendto(nl->fd, buf, len, 0, 
+		      (struct sockaddr *) &snl, sizeof(snl));
+}
+
+/**
+ * mnl_socket_recvfrom - receive a netlink message
+ * \param nl netlink socket obtained via mnl_socket_open()
+ * \param buf buffer that you want to use to store the netlink message
+ * \param bufsiz size of the buffer passed to store the netlink message
+ *
+ * On error, it returns -1 and errno is appropriately set. If errno is set
+ * to ENOSPC, it means that the buffer that you have passed to store the
+ * netlink message is too small, so you have received a truncated message.
+ * To avoid this, you have to allocate a buffer of MNL_SOCKET_BUFFER_SIZE
+ * (which is 8KB, see linux/netlink.h for more information). Using this
+ * buffer size ensures that your buffer is big enough to store the netlink
+ * message without truncating it.
+ */
+ssize_t mnl_socket_recvfrom(const struct mnl_socket *nl,
+					  void *buf, size_t bufsiz)
+{
+	ssize_t ret;
+	struct sockaddr_nl addr;
+	struct iovec iov = {
+		.iov_base	= buf,
+		.iov_len	= bufsiz,
+	};
+	struct msghdr msg = {
+		.msg_name	= &addr,
+		.msg_namelen	= sizeof(struct sockaddr_nl),
+		.msg_iov	= &iov,
+		.msg_iovlen	= 1,
+		.msg_control	= NULL,
+		.msg_controllen	= 0,
+		.msg_flags	= 0,
+	};
+	ret = recvmsg(nl->fd, &msg, 0);
+	if (ret == -1)
+		return ret;
+
+	if (msg.msg_flags & MSG_TRUNC) {
+		errno = ENOSPC;
+		return -1;
+	}
+	if (msg.msg_namelen != sizeof(struct sockaddr_nl)) {
+		errno = EINVAL;
+		return -1;
+	}
+	return ret;
+}
+
+/**
+ * mnl_socket_close - close a given netlink socket
+ * \param nl netlink socket obtained via mnl_socket_open()
+ *
+ * On error, this function returns -1 and errno is appropriately set.
+ * On success, it returns 0.
+ */
+int mnl_socket_close(struct mnl_socket *nl)
+{
+	int ret = close(nl->fd);
+	free(nl);
+	return ret;
+}
+
+/**
+ * mnl_socket_setsockopt - set Netlink socket option
+ * \param nl netlink socket obtained via mnl_socket_open()
+ * \param type type of Netlink socket options
+ * \param buf the buffer that contains the data about this option
+ * \param len the size of the buffer passed
+ *
+ * This function allows you to set some Netlink socket option. As of writing
+ * this (see linux/netlink.h), the existing options are:
+ *
+ *	- \#define NETLINK_ADD_MEMBERSHIP  1
+ *	- \#define NETLINK_DROP_MEMBERSHIP 2
+ *	- \#define NETLINK_PKTINFO         3
+ *	- \#define NETLINK_BROADCAST_ERROR 4
+ *	- \#define NETLINK_NO_ENOBUFS      5
+ *
+ * In the early days, Netlink only supported 32 groups expressed in a
+ * 32-bits mask. However, since 2.6.14, Netlink may have up to 2^32 multicast
+ * groups but you have to use setsockopt() with NETLINK_ADD_MEMBERSHIP to
+ * join a given multicast group. This function internally calls setsockopt()
+ * to join a given netlink multicast group. You can still use mnl_bind()
+ * and the 32-bit mask to join a set of Netlink multicast groups.
+ *
+ * On error, this function returns -1 and errno is appropriately set.
+ */
+int mnl_socket_setsockopt(const struct mnl_socket *nl, int type,
+					void *buf, socklen_t len)
+{
+	return setsockopt(nl->fd, SOL_NETLINK, type, buf, len);
+}
+
+/**
+ * mnl_socket_getsockopt - get a Netlink socket option
+ * \param nl netlink socket obtained via mnl_socket_open()
+ * \param type type of Netlink socket options
+ * \param buf pointer to the buffer to store the value of this option
+ * \param len size of the information written in the buffer
+ *
+ * On error, this function returns -1 and errno is appropriately set.
+ */
+int mnl_socket_getsockopt(const struct mnl_socket *nl, int type,
+					void *buf, socklen_t *len)
+{
+	return getsockopt(nl->fd, SOL_NETLINK, type, buf, len);
+}
+
+/**
+ * @}
+ */

root/package/link4all/quectel-CM/quectel1.6.0.15_src/main.c

@@ -0,0 +1,947 @@
+/******************************************************************************
+  @file    main.c
+  @brief   The entry program.
+
+  DESCRIPTION
+  Connectivity Management Tool for USB network adapter of Quectel wireless cellular modules.
+
+  INITIALIZATION AND SEQUENCING REQUIREMENTS
+  None.
+
+  ---------------------------------------------------------------------------
+  Copyright (c) 2016 -2020 Quectel Wireless Solution, Co., Ltd.  All Rights Reserved.
+  Quectel Wireless Solution Proprietary and Confidential.
+  ---------------------------------------------------------------------------
+******************************************************************************/
+
+#include "QMIThread.h"
+#include <sys/wait.h>
+#include <sys/utsname.h>
+#include <sys/time.h>
+#include <dirent.h>
+
+#include "util.h"
+//#define CONFIG_EXIT_WHEN_DIAL_FAILED
+//#define CONFIG_BACKGROUND_WHEN_GET_IP
+//#define CONFIG_PID_FILE_FORMAT "/var/run/quectel-CM-%s.pid" //for example /var/run/quectel-CM-wwan0.pid
+
+int debug_qmi = 0;
+int main_loop = 0;
+int qmidevice_control_fd[2];
+static int signal_control_fd[2];
+
+extern const struct qmi_device_ops gobi_qmidev_ops;
+extern const struct qmi_device_ops qmiwwan_qmidev_ops;
+extern int ql_ifconfig(int argc, char *argv[]);
+extern int ql_get_netcard_driver_info(const char*);
+extern int ql_capture_usbmon_log(PROFILE_T *profile, const char *log_path);
+extern void ql_stop_usbmon_log(PROFILE_T *profile);
+
+#ifdef CONFIG_BACKGROUND_WHEN_GET_IP
+static int daemon_pipe_fd[2];
+
+static void ql_prepare_daemon(void) {
+    pid_t daemon_child_pid;
+
+    if (pipe(daemon_pipe_fd) < 0) {
+        dbg_time("%s Faild to create daemon_pipe_fd: %d (%s)", __func__, errno, strerror(errno));
+        return;
+    }
+
+    daemon_child_pid = fork();
+    if (daemon_child_pid > 0) {
+        struct pollfd pollfds[] = {{daemon_pipe_fd[0], POLLIN, 0}, {0, POLLIN, 0}};
+        int ne, ret, nevents = sizeof(pollfds)/sizeof(pollfds[0]);
+        int signo;
+
+        //dbg_time("father");
+
+        close(daemon_pipe_fd[1]);
+
+        if (socketpair( AF_LOCAL, SOCK_STREAM, 0, signal_control_fd) < 0 ) {
+            dbg_time("%s Faild to create main_control_fd: %d (%s)", __func__, errno, strerror(errno));
+            return;
+        }
+
+        pollfds[1].fd = signal_control_fd[1];
+
+        while (1) {
+            do {
+                ret = poll(pollfds, nevents, -1);
+            } while ((ret < 0) && (errno == EINTR));
+
+            if (ret < 0) {
+                dbg_time("%s poll=%d, errno: %d (%s)", __func__, ret, errno, strerror(errno));
+                goto __daemon_quit;
+            }
+
+            for (ne = 0; ne < nevents; ne++) {
+                int fd = pollfds[ne].fd;
+                short revents = pollfds[ne].revents;
+
+                if (revents & (POLLERR | POLLHUP | POLLNVAL)) {
+                    //dbg_time("%s poll err/hup", __func__);
+                    //dbg_time("poll fd = %d, events = 0x%04x", fd, revents);
+                    if (revents & POLLHUP)
+                        goto __daemon_quit;
+                }
+
+                if ((revents & POLLIN) &&  read(fd, &signo, sizeof(signo)) == sizeof(signo)) {
+                    if (signal_control_fd[1] == fd) {
+                        if (signo == SIGCHLD) {
+                            int status;
+                            int pid = waitpid(daemon_child_pid, &status, 0);
+                            dbg_time("waitpid pid=%d, status=%x", pid, status);
+                            goto __daemon_quit;
+                        } else {
+                            kill(daemon_child_pid, signo);
+                        }
+                    } else if (daemon_pipe_fd[0] == fd) {
+                        //dbg_time("daemon_pipe_signo = %d", signo);
+                        goto __daemon_quit;
+                    }
+                }
+            }
+        }
+__daemon_quit:
+        //dbg_time("father exit");
+        _exit(0);
+    } else if (daemon_child_pid == 0) {
+        close(daemon_pipe_fd[0]);
+        //dbg_time("child", getpid());
+    } else {
+        close(daemon_pipe_fd[0]);
+        close(daemon_pipe_fd[1]);
+        dbg_time("%s Faild to create daemon_child_pid: %d (%s)", __func__, errno, strerror(errno));
+    }
+}
+
+static void ql_enter_daemon(int signo) {
+    if (daemon_pipe_fd[1] > 0)
+        if (signo) {
+            write(daemon_pipe_fd[1], &signo, sizeof(signo));
+            sleep(1);
+        }
+        close(daemon_pipe_fd[1]);
+        daemon_pipe_fd[1] = -1;
+        setsid();
+    }
+#endif
+
+//UINT ifc_get_addr(const char *ifname);
+static int s_link = -1;
+static void usbnet_link_state(int state)
+{
+    s_link = state ? 1 : 0;
+}
+static void usbnet_link_change(int link, PROFILE_T *profile) {
+    if (s_link == link)
+        return;
+
+    s_link = link;
+
+    if (link) {
+        udhcpc_start(profile);
+    } else {
+        udhcpc_stop(profile);
+    }
+
+#ifdef CONFIG_BACKGROUND_WHEN_GET_IP
+    if (link && daemon_pipe_fd[1] > 0) {
+        int timeout = 6;
+        while (timeout-- /*&& ifc_get_addr(profile->usbnet_adapter) == 0*/) {
+            sleep(1);
+        }
+        ql_enter_daemon(SIG_EVENT_START);
+    }
+#endif
+}
+
+static int check_ipv4_address(PROFILE_T *now_profile) {
+    PROFILE_T new_profile_v;
+    PROFILE_T *new_profile = &new_profile_v;
+
+    memcpy(new_profile, now_profile, sizeof(PROFILE_T));
+    if (requestGetIPAddress(new_profile, IpFamilyV4) == 0) {
+         if (new_profile->ipv4.Address != now_profile->ipv4.Address || debug_qmi) {
+             unsigned char *l = (unsigned char *)&now_profile->ipv4.Address;
+             unsigned char *r = (unsigned char *)&new_profile->ipv4.Address;
+             dbg_time("localIP: %d.%d.%d.%d VS remoteIP: %d.%d.%d.%d",
+                     l[3], l[2], l[1], l[0], r[3], r[2], r[1], r[0]);
+        }
+        return (new_profile->ipv4.Address == now_profile->ipv4.Address);
+    }
+    return 0;
+}
+
+static void main_send_event_to_qmidevice(int triger_event) {
+     write(qmidevice_control_fd[0], &triger_event, sizeof(triger_event));
+}
+
+static void send_signo_to_main(int signo) {
+     write(signal_control_fd[0], &signo, sizeof(signo));
+}
+
+void qmidevice_send_event_to_main(int triger_event) {
+     write(qmidevice_control_fd[1], &triger_event, sizeof(triger_event));
+}
+
+void qmidevice_send_event_to_main_ext(int triger_event, void *data, unsigned len) {
+     write(qmidevice_control_fd[1], &triger_event, sizeof(triger_event));
+     write(qmidevice_control_fd[1], data, len);
+}
+
+#define MAX_PATH 256
+
+static int ls_dir(const char *dir, int (*match)(const char *dir, const char *file, void *argv[]), void *argv[])
+{
+    DIR *pDir;
+    struct dirent* ent = NULL;
+    int match_times = 0;
+
+    pDir = opendir(dir);
+    if (pDir == NULL)  {
+        dbg_time("Cannot open directory: %s, errno: %d (%s)", dir, errno, strerror(errno));
+        return 0;
+    }
+
+    while ((ent = readdir(pDir)) != NULL)  {
+        match_times += match(dir, ent->d_name, argv);
+    }
+    closedir(pDir);
+
+    return match_times;
+}
+
+static int is_same_linkfile(const char *dir, const char *file,  void *argv[])
+{
+    const char *qmichannel = (const char *)argv[1];
+    char linkname[MAX_PATH];
+    char filename[MAX_PATH];
+    int linksize;
+
+    snprintf(linkname, MAX_PATH, "%s/%s", dir, file);
+    linksize = readlink(linkname, filename, MAX_PATH);
+    if (linksize <= 0)
+        return 0;
+
+    filename[linksize] = 0;
+    if (strcmp(filename, qmichannel))
+        return 0;
+
+    dbg_time("%s -> %s", linkname, filename);
+    return 1;
+}
+
+static int is_brother_process(const char *dir, const char *file, void *argv[])
+{
+    //const char *myself = (const char *)argv[0];
+    char linkname[MAX_PATH];
+    char filename[MAX_PATH];
+    int linksize;
+    int i = 0, kill_timeout = 15;
+    pid_t pid;
+
+    //dbg_time("%s", file);
+    while (file[i]) {
+        if (!isdigit(file[i]))
+            break;
+        i++;
+    }
+
+    if (file[i]) {
+        //dbg_time("%s not digit", file);
+        return 0;
+    }
+
+    snprintf(linkname, MAX_PATH, "%s/%s/exe", dir, file);
+    linksize = readlink(linkname, filename, MAX_PATH);
+    if (linksize <= 0)
+        return 0;
+
+    filename[linksize] = 0;
+
+    pid = atoi(file);
+    if (pid >= getpid())
+        return 0;
+
+    snprintf(linkname, MAX_PATH, "%s/%s/fd", dir, file);
+    if (!ls_dir(linkname, is_same_linkfile, argv))
+        return 0;
+
+    dbg_time("%s/%s/exe -> %s", dir, file, filename);
+    while (kill_timeout-- && !kill(pid, 0))
+    {
+        kill(pid, SIGTERM);
+        sleep(1);
+    }
+    if (!kill(pid, 0))
+    {
+        dbg_time("force kill %s/%s/exe -> %s", dir, file, filename);
+        kill(pid, SIGKILL);
+        sleep(1);
+    }
+
+    return 1;
+}
+
+static int kill_brothers(const char *qmichannel)
+{
+    char myself[MAX_PATH];
+    int filenamesize;
+    void *argv[2] = {myself, (void *)qmichannel};
+
+    filenamesize = readlink("/proc/self/exe", myself, MAX_PATH);
+    if (filenamesize <= 0)
+        return 0;
+    myself[filenamesize] = 0;
+
+    if (ls_dir("/proc", is_brother_process, argv))
+        sleep(1);
+
+    return 0;
+}
+
+static int kill_data_call_pdp(int pdp, char *self) {
+    int pid;
+    char *p = NULL;
+
+    p = self;
+    while (*self) {
+        if (*self == '/')
+            p = self+1;
+        self++;
+    }
+
+    pid = getpid_by_pdp(pdp, p);
+    if (pid > 0) {
+        dbg_time("send SIGINT to process %d", pid);
+        return kill(pid, SIGINT);
+    }
+
+    return -1;
+}
+
+static void ql_sigaction(int signo) {
+     if (SIGALRM == signo)
+         send_signo_to_main(SIG_EVENT_START);
+     else
+     {
+        main_loop = 0;
+        send_signo_to_main(SIG_EVENT_STOP);
+        main_send_event_to_qmidevice(SIG_EVENT_STOP); //main may be wating qmi response
+    }
+}
+
+pthread_t gQmiThreadID;
+
+static int usage(const char *progname) {
+     dbg_time("Usage: %s [options]", progname);
+     dbg_time("-s [apn [user password auth]]          Set apn/user/password/auth get from your network provider");
+     dbg_time("-p pincode                             Verify sim card pin if sim card is locked");
+     dbg_time("-f logfilename                         Save log message of this program to file");
+     dbg_time("-u usbmonlog filename                  Save usbmon log of this program to file");
+     dbg_time("-i interface                           Specify network interface(default auto-detect)");
+     dbg_time("-4                                     IPv4 protocol");
+     dbg_time("-6                                     IPv6 protocol");
+     dbg_time("-m muxID                               Specify muxid when set multi-pdn data connection.");
+     dbg_time("-n channelID                           Specify channelID when set multi-pdn data connection(default 1).");
+	 dbg_time("-k channelID                           Send SIGINT to quectel-CM which multi-pdn is channelID.");
+     dbg_time("-r                                     Detach and attach kernel driver before open device.");
+     dbg_time("-b                                     enable network interface bridge function(default 0).");
+     dbg_time("[Examples]");
+     dbg_time("Example 1: %s ", progname);
+     dbg_time("Example 2: %s -s 3gnet ", progname);
+     dbg_time("Example 3: %s -s 3gnet carl 1234 0 -p 1234 -f gobinet_log.txt", progname);
+     return 0;
+}
+
+int qmi_main(PROFILE_T *profile)
+{
+    int triger_event = 0;
+    int signo;
+#ifdef CONFIG_SIM
+    SIM_Status SIMStatus;
+#endif
+    UCHAR PSAttachedState;
+    UCHAR  IPv4ConnectionStatus = 0xff; //unknow state
+    UCHAR  IPv6ConnectionStatus = 0xff; //unknow state
+    unsigned SetupCallFail = 0;
+    unsigned long SetupCallAllowTime = clock_msec();
+    int qmierr = 0;
+    char * save_usbnet_adapter = NULL;
+
+    /* signal trigger quit event */
+    signal(SIGINT, ql_sigaction);
+    signal(SIGTERM, ql_sigaction);
+    /* timer routine */
+    signal(SIGALRM, ql_sigaction);
+
+#ifdef CONFIG_BACKGROUND_WHEN_GET_IP
+    ql_prepare_daemon();
+#endif
+
+//sudo apt-get install udhcpc
+//sudo apt-get remove ModemManager
+__main_loop:
+    if (profile->reattach_flag) {
+        if (!reattach_driver(profile)) 
+            sleep(2);
+    }
+
+    /* try to recreate FDs*/
+    if (socketpair( AF_LOCAL, SOCK_STREAM, 0, signal_control_fd) < 0 ) {
+        dbg_time("%s Faild to create main_control_fd: %d (%s)", __func__, errno, strerror(errno));
+        return -1;
+    }
+
+    if ( socketpair( AF_LOCAL, SOCK_STREAM, 0, qmidevice_control_fd ) < 0 ) {
+        dbg_time("%s Failed to create thread control socket pair: %d (%s)", __func__, errno, strerror(errno));
+        return 0;
+    }
+
+    while (!profile->qmichannel) {
+        char qmichannel[32+1] = {'\0'};
+        char usbnet_adapter[32+1] = {'\0'};
+        
+        if (!qmidevice_detect(qmichannel, usbnet_adapter, sizeof(qmichannel), &profile->busnum, &profile->devnum)) {
+            dbg_time("qmidevice_detect failed");
+            continue;
+        } else {
+            if (!(profile->qmichannel))
+                strset(profile->qmichannel, qmichannel);
+            if (!(profile->usbnet_adapter))
+                strset(profile->usbnet_adapter, usbnet_adapter);
+                break;
+        }
+        if (main_loop) {
+            int wait_for_device = 3000;
+            dbg_time("Wait for Quectel modules connect");
+            while (wait_for_device && main_loop) {
+                wait_for_device -= 100;
+                usleep(100*1000);
+            }
+            continue;
+        }
+        dbg_time("Cannot find qmichannel(%s) usbnet_adapter(%s) for Quectel modules", profile->qmichannel, profile->usbnet_adapter);
+        return -ENODEV;
+    }
+
+    if (qmidev_is_gobinet(profile->qmichannel)) {
+        profile->qmi_ops = &gobi_qmidev_ops;
+    }
+    else {
+        profile->qmi_ops = &qmiwwan_qmidev_ops;
+    }
+    qmidev_send = profile->qmi_ops->send;
+
+    if (profile->qmap_mode == 0 || profile->qmap_mode == 1)
+        kill_brothers(profile->qmichannel);
+
+    if (pthread_create( &gQmiThreadID, 0, profile->qmi_ops->read, (void *)profile) != 0) {
+        dbg_time("%s Failed to create QMIThread: %d (%s)", __func__, errno, strerror(errno));
+            return 0;
+    }
+
+    if ((read(qmidevice_control_fd[0], &triger_event, sizeof(triger_event)) != sizeof(triger_event))
+        || (triger_event != RIL_INDICATE_DEVICE_CONNECTED)) {
+        dbg_time("%s Failed to init QMIThread: %d (%s)", __func__, errno, strerror(errno));
+        return 0;
+    }
+
+    if (profile->qmi_ops->init && profile->qmi_ops->init(profile)) {
+        dbg_time("%s Failed to qmi init: %d (%s)", __func__, errno, strerror(errno));
+            return 0;
+    }
+
+#ifdef CONFIG_VERSION
+    requestBaseBandVersion(NULL);
+#endif
+    requestSetEthMode(profile);
+	if (profile->loopback_state) {
+    	requestSetLoopBackState(profile->loopback_state, profile->replication_factor);
+    	profile->loopback_state = 0;
+    }
+#ifdef CONFIG_SIM
+    qmierr = requestGetSIMStatus(&SIMStatus);
+    while (qmierr == QMI_ERR_OP_DEVICE_UNSUPPORTED) {
+        sleep(1);
+        qmierr = requestGetSIMStatus(&SIMStatus);
+    }
+    if ((SIMStatus == SIM_PIN) && profile->pincode) {
+        requestEnterSimPin(profile->pincode);
+    }
+#ifdef CONFIG_IMSI_ICCID
+    if (SIMStatus == SIM_READY) {
+        requestGetICCID();
+        requestGetIMSI();
+    }
+#endif
+#endif
+#ifdef CONFIG_APN
+    if (profile->apn || profile->user || profile->password) {
+        requestSetProfile(profile);
+    }
+    requestGetProfile(profile);
+#endif
+    requestRegistrationState(&PSAttachedState);
+
+    send_signo_to_main(SIG_EVENT_CHECK);
+
+#ifdef CONFIG_PID_FILE_FORMAT
+    {
+        char cmd[255];
+        sprintf(cmd, "echo %d > " CONFIG_PID_FILE_FORMAT, getpid(), profile->usbnet_adapter);
+        system(cmd);
+    }
+#endif
+
+    while (1)
+    {
+        struct pollfd pollfds[] = {{signal_control_fd[1], POLLIN, 0}, {qmidevice_control_fd[0], POLLIN, 0}};
+        int ne, ret, nevents = sizeof(pollfds)/sizeof(pollfds[0]);
+
+        do {
+            ret = poll(pollfds, nevents,  15*1000);
+        } while ((ret < 0) && (errno == EINTR));
+
+        if (ret == 0)
+        {
+            send_signo_to_main(SIG_EVENT_CHECK);
+            continue;
+        }
+
+        if (ret <= 0) {
+            dbg_time("%s poll=%d, errno: %d (%s)", __func__, ret, errno, strerror(errno));
+            goto __main_quit;
+        }
+
+        for (ne = 0; ne < nevents; ne++) {
+            int fd = pollfds[ne].fd;
+            short revents = pollfds[ne].revents;
+
+            if (revents & (POLLERR | POLLHUP | POLLNVAL)) {
+                dbg_time("%s poll err/hup", __func__);
+                dbg_time("epoll fd = %d, events = 0x%04x", fd, revents);
+                main_send_event_to_qmidevice(RIL_REQUEST_QUIT);
+                if (revents & POLLHUP)
+                    goto __main_quit;
+            }
+
+            if ((revents & POLLIN) == 0)
+                continue;
+
+            if (fd == signal_control_fd[1])
+            {
+                if (read(fd, &signo, sizeof(signo)) == sizeof(signo))
+                {
+                    alarm(0);
+                    switch (signo)
+                    {
+                        case SIG_EVENT_START:
+                            if (PSAttachedState != 1 && profile->loopback_state == 0)
+                                break;
+                            
+                            if (SetupCallAllowTime > clock_msec()) {
+                                alarm((SetupCallAllowTime - clock_msec()+999)/1000);
+                                break;
+                            }
+
+                            if (profile->enable_ipv4 && IPv4ConnectionStatus !=  QWDS_PKT_DATA_CONNECTED) {
+                                qmierr = requestSetupDataCall(profile, IpFamilyV4);
+
+                                if ((qmierr > 0) && profile->user && profile->user[0] && profile->password && profile->password[0]) {
+                                    int old_auto =  profile->auth;
+
+                                    //may be fail because wrong auth mode, try pap->chap, or chap->pap
+                                    profile->auth = (profile->auth == 1) ? 2 : 1;
+                                	qmierr = requestSetupDataCall(profile, IpFamilyV4);
+
+                                    if (qmierr)
+                                        profile->auth = old_auto; //still fail, restore old auth moe
+                                }
+
+                                if (!qmierr) {
+                                    qmierr = requestGetIPAddress(profile, IpFamilyV4);
+                                    if (!qmierr)
+                                        IPv4ConnectionStatus = QWDS_PKT_DATA_CONNECTED;
+                                }
+                                        
+                            }
+
+                            if (profile->enable_ipv6 && IPv6ConnectionStatus !=  QWDS_PKT_DATA_CONNECTED) {
+                                qmierr = requestSetupDataCall(profile, IpFamilyV6);
+
+                                if (!qmierr) {
+                                    qmierr = requestGetIPAddress(profile, IpFamilyV6);
+                                    if (!qmierr)
+                                        IPv6ConnectionStatus = QWDS_PKT_DATA_CONNECTED;
+                                }
+                            }
+                                
+                            if ((profile->enable_ipv4 && IPv4ConnectionStatus ==  QWDS_PKT_DATA_DISCONNECTED)
+                                    || (profile->enable_ipv6 && IPv6ConnectionStatus ==  QWDS_PKT_DATA_DISCONNECTED)) {
+                                const unsigned allow_time[] = {5, 10, 20, 40, 60};
+
+                                if (SetupCallFail < (sizeof(allow_time)/sizeof(unsigned)))
+                                    SetupCallAllowTime = allow_time[SetupCallFail];
+                                else
+                                    SetupCallAllowTime = 60;
+                                SetupCallFail++;
+                                dbg_time("try to requestSetupDataCall %ld second later", SetupCallAllowTime);
+                                alarm(SetupCallAllowTime);
+                                SetupCallAllowTime = SetupCallAllowTime*1000 + clock_msec();
+#ifdef CONFIG_EXIT_WHEN_DIAL_FAILED
+                                send_signo_to_main(SIG_EVENT_STOP);
+#endif
+                            }
+                            else if (IPv4ConnectionStatus ==  QWDS_PKT_DATA_CONNECTED || IPv6ConnectionStatus ==  QWDS_PKT_DATA_CONNECTED) {
+                                SetupCallFail = 0;
+                                SetupCallAllowTime = clock_msec();
+                            }
+                        break;
+
+                        case SIG_EVENT_CHECK:
+                            #ifdef CONFIG_SIGNALINFO
+                            requestGetSignalInfo();
+                            #endif
+                            if (profile->enable_ipv4) {
+                                 requestQueryDataCall(&IPv4ConnectionStatus, IpFamilyV4);
+
+                                //local ip is different with remote ip
+                                if (QWDS_PKT_DATA_CONNECTED == IPv4ConnectionStatus && check_ipv4_address(profile) == 0) {
+                                    requestDeactivateDefaultPDP(profile, IpFamilyV4);
+                                    IPv4ConnectionStatus = QWDS_PKT_DATA_DISCONNECTED;
+                                }
+                            }
+                            else {
+                                IPv4ConnectionStatus = QWDS_PKT_DATA_DISCONNECTED;
+                            }
+
+                            if (profile->enable_ipv6) {
+                                requestQueryDataCall(&IPv6ConnectionStatus, IpFamilyV6);
+                            }
+                            else {
+                                IPv6ConnectionStatus = QWDS_PKT_DATA_DISCONNECTED;
+                            }
+
+                            if (IPv4ConnectionStatus ==  QWDS_PKT_DATA_DISCONNECTED && IPv6ConnectionStatus ==  QWDS_PKT_DATA_DISCONNECTED) {
+                                usbnet_link_change(0, profile);
+                            }
+                            else if (IPv4ConnectionStatus ==  QWDS_PKT_DATA_CONNECTED || IPv6ConnectionStatus ==  QWDS_PKT_DATA_CONNECTED) {
+                                usbnet_link_change(1, profile);
+                            }
+                            
+                            if ((profile->enable_ipv4 && IPv4ConnectionStatus ==  QWDS_PKT_DATA_DISCONNECTED)
+                                || (profile->enable_ipv6 && IPv6ConnectionStatus ==  QWDS_PKT_DATA_DISCONNECTED)) {
+                                send_signo_to_main(SIG_EVENT_START);
+                            }
+                        break;
+
+                        case SIG_EVENT_STOP:
+                            if (profile->enable_ipv4 && IPv4ConnectionStatus ==  QWDS_PKT_DATA_CONNECTED) {
+                                requestDeactivateDefaultPDP(profile, IpFamilyV4);
+                            }
+                            if (profile->enable_ipv6 && IPv6ConnectionStatus ==  QWDS_PKT_DATA_CONNECTED) {
+                                    requestDeactivateDefaultPDP(profile, IpFamilyV6);
+                            }
+                            usbnet_link_change(0, profile);
+                            if (profile->qmi_ops->deinit)
+                                profile->qmi_ops->deinit();
+                            main_send_event_to_qmidevice(RIL_REQUEST_QUIT);
+                            goto __main_quit;
+                        break;
+
+                        default:
+                        break;
+                    }
+                }
+            }
+
+            if (fd == qmidevice_control_fd[0]) {
+                if (read(fd, &triger_event, sizeof(triger_event)) == sizeof(triger_event)) {
+                    switch (triger_event) {
+                        case RIL_INDICATE_DEVICE_DISCONNECTED:
+                            usbnet_link_change(0, profile);
+                            if (main_loop)
+                            {
+                                if (pthread_join(gQmiThreadID, NULL)) {
+                                    dbg_time("%s Error joining to listener thread (%s)", __func__, strerror(errno));
+                                }
+                                profile->qmichannel = NULL;
+                                profile->usbnet_adapter = save_usbnet_adapter;
+                                goto __main_loop;
+                            }
+                            goto __main_quit;
+                        break;
+
+                        case RIL_UNSOL_RESPONSE_VOICE_NETWORK_STATE_CHANGED:
+                            requestRegistrationState(&PSAttachedState);
+                            if (PSAttachedState == 1) {
+                                if ((profile->enable_ipv4 && IPv4ConnectionStatus ==  QWDS_PKT_DATA_DISCONNECTED)
+                                    || (profile->enable_ipv6 && IPv6ConnectionStatus ==  QWDS_PKT_DATA_DISCONNECTED)) {
+                                    send_signo_to_main(SIG_EVENT_START);
+                                }
+                             } else {
+                                SetupCallAllowTime = clock_msec();
+                             }
+                        break;
+
+                        case RIL_UNSOL_DATA_CALL_LIST_CHANGED:
+                            if (IPv4ConnectionStatus ==  QWDS_PKT_DATA_CONNECTED || IPv6ConnectionStatus ==  QWDS_PKT_DATA_CONNECTED)
+                                SetupCallAllowTime = clock_msec() + 1000; //from connect -> disconnect, do not re-dail immediately, wait network stable
+                                    send_signo_to_main(SIG_EVENT_CHECK);
+                        break;
+
+                        case MODEM_REPORT_RESET_EVENT:
+                        {
+                            unsigned int time_to_wait = 20;
+                            unsigned int time_expired = 0;
+                            dbg_time("main recv MODEM RESET SIGNAL");
+                            dbg_time("quit QMI thread and wait %ds and try to restart", time_to_wait);
+                            main_send_event_to_qmidevice(RIL_REQUEST_QUIT);
+                            /** NOTICE
+                             * DO NOT CALL usbnet_link_change(0, profile) DIRECTLLY
+                             * for, the modem may go into wrong state(only ttyUSB0 left) and wont go back
+                             */
+                            usbnet_link_state(0);
+                            /* close FDs, for we want restart. */
+                            close(signal_control_fd[0]);
+                            close(signal_control_fd[1]);
+                            close(qmidevice_control_fd[0]);
+                            close(qmidevice_control_fd[1]);
+                            while (time_expired++ < time_to_wait) {
+                                sleep(1);
+                                char qmidev[64] = {'\0'};
+                                snprintf(qmidev, sizeof(qmidev), "/dev/bus/usb/%03d/%03d", profile->busnum, profile->devnum);
+                                if (access(qmidev, F_OK)) {
+                                    dbg_time("whoo, fatal error info, qmi device node disappeared!!! cannot continue!\n");
+                                    goto __main_quit;
+                                }
+                            }
+                            dbg_time("main try do restart");
+                            goto __main_loop;
+                        }
+                    	case RIL_UNSOL_LOOPBACK_CONFIG_IND:
+                        {
+                        	QMI_WDA_SET_LOOPBACK_CONFIG_IND_MSG SetLoopBackInd;
+                        	if (read(fd, &SetLoopBackInd, sizeof(SetLoopBackInd)) == sizeof(SetLoopBackInd)) {
+                            	profile->loopback_state = SetLoopBackInd.loopback_state.TLVVaule;
+                            	profile->replication_factor = le32_to_cpu(SetLoopBackInd.replication_factor.TLVVaule);
+                            	dbg_time("SetLoopBackInd: loopback_state=%d, replication_factor=%u",
+                                	profile->loopback_state, profile->replication_factor);
+                            	if (profile->loopback_state)
+                                	send_signo_to_main(SIG_EVENT_START);
+                            }
+                        }
+                    	break;
+                        default:
+                        break;
+                    }
+                }
+            }
+        }
+    }
+
+__main_quit:
+    usbnet_link_change(0, profile);
+    if (pthread_join(gQmiThreadID, NULL)) {
+        dbg_time("%s Error joining to listener thread (%s)", __func__, strerror(errno));
+    }
+    close(signal_control_fd[0]);
+    close(signal_control_fd[1]);
+    close(qmidevice_control_fd[0]);
+    close(qmidevice_control_fd[1]);
+    dbg_time("%s exit", __func__);
+
+#ifdef CONFIG_PID_FILE_FORMAT
+    {
+        char cmd[255];
+        sprintf(cmd, "rm  " CONFIG_PID_FILE_FORMAT, profile.usbnet_adapter);
+        system(cmd);
+    }
+#endif
+
+    return 0;
+}
+
+#define has_more_argv() ((opt < argc) && (argv[opt][0] != '-'))
+int main(int argc, char *argv[])
+{
+    int opt = 1;
+    char * save_usbnet_adapter = NULL;
+    const char *usbmon_logfile = NULL;
+    PROFILE_T profile;
+    int ret = -1;
+
+    dbg_time("Quectel_QConnectManager_Linux_V1.6.0.15");
+    memset(&profile, 0x00, sizeof(profile));
+    profile.pdp = CONFIG_DEFAULT_PDP;
+
+    if (!strcmp(argv[argc-1], "&"))
+        argc--;
+
+    opt = 1;
+    while  (opt < argc) {
+        if (argv[opt][0] != '-')
+            return usage(argv[0]);
+
+        switch (argv[opt++][1])
+        {
+            case 's':
+                profile.apn = profile.user = profile.password = "";
+                if (has_more_argv())
+                    profile.apn = argv[opt++];
+                if (has_more_argv())
+                    profile.user = argv[opt++];
+                if (has_more_argv())
+                {
+                    profile.password = argv[opt++];
+                    if (profile.password && profile.password[0])
+                        profile.auth = 2; //default chap, customers may miss auth
+                }
+                if (has_more_argv())
+                    profile.auth = argv[opt++][0] - '0';
+            break;
+
+            case 'm':
+                if (has_more_argv())
+                    profile.muxid = argv[opt++][0] - '0';
+                break;
+
+            case 'p':
+                if (has_more_argv())
+                    profile.pincode = argv[opt++];
+            break;
+
+            case 'n':
+                if (has_more_argv())
+                    profile.pdp = argv[opt++][0] - '0';
+            break;
+
+            case 'f':
+                if (has_more_argv())
+                {
+                    const char * filename = argv[opt++];
+                    logfilefp = fopen(filename, "a+");
+                    if (!logfilefp) {
+                        dbg_time("Fail to open %s, errno: %d(%s)", filename, errno, strerror(errno));
+                     }
+                }
+            break;
+
+            case 'i':
+                if (has_more_argv())
+                    profile.usbnet_adapter = save_usbnet_adapter = argv[opt++];
+            break;
+
+            case 'v':
+                debug_qmi = 1;
+            break;
+
+            case 'l':
+            	if (has_more_argv()) {
+                    profile.replication_factor = atoi(argv[opt++]);
+                	if (profile.replication_factor > 0)
+                    	profile.loopback_state = 1;
+                }
+            	else
+                 main_loop = 1;
+            break;
+
+            case '4':
+                profile.enable_ipv4 = 1; 
+            break;
+
+            case '6':
+                profile.enable_ipv6 = 1;
+            break;
+
+            case 'd':
+                if (has_more_argv()) {
+                    profile.qmichannel = argv[opt++];
+                    if (qmidev_is_pciemhi(profile.qmichannel))
+                        profile.usbnet_adapter = "pcie_mhi0";
+                }
+            break;
+
+            case 'r':
+                profile.reattach_flag = 1;
+            break;
+
+        	case 'u':
+                if (has_more_argv()) {
+                    usbmon_logfile = argv[opt++];
+                }
+            break;
+
+        	case 'b':
+                profile.enable_bridge = 1;
+            break;
+			
+            case 'k':
+                if (has_more_argv()) {
+                    return kill_data_call_pdp(argv[opt++][0] - '0', argv[0]);
+                }			
+            
+            default:
+                return usage(argv[0]);
+            break;
+        }
+    }
+
+    if (profile.enable_ipv4 != 1 && profile.enable_ipv6 != 1) { // default enable IPv4
+        profile.enable_ipv4 = 1;
+    }
+
+    if (!(profile.qmichannel) || !(profile.usbnet_adapter)) {
+        char qmichannel[32+1] = {'\0'};
+        char usbnet_adapter[32+1] = {'\0'};
+
+        if (profile.usbnet_adapter)
+            strcpy(usbnet_adapter, profile.usbnet_adapter);
+        
+        if (qmidevice_detect(qmichannel, usbnet_adapter, sizeof(qmichannel), &profile.busnum, &profile.devnum)) {
+        	profile.hardware_interface = HARDWARE_USB;
+        }
+        else if (mhidevice_detect(qmichannel, usbnet_adapter, &profile)) {
+            profile.hardware_interface = HARDWARE_PCIE;
+        }
+        else {
+            dbg_time("qmidevice_detect failed");
+            goto error;
+        }
+ 
+        if (!(profile.qmichannel))
+            strset(profile.qmichannel, qmichannel);
+        if (!(profile.usbnet_adapter))
+            strset(profile.usbnet_adapter, usbnet_adapter);
+    
+        ql_get_netcard_driver_info(profile.usbnet_adapter);
+
+        if ((profile.hardware_interface == HARDWARE_USB) && usbmon_logfile)
+            ql_capture_usbmon_log(&profile, usbmon_logfile);
+
+        if (profile.hardware_interface == HARDWARE_USB) {
+            profile.software_interface = get_driver_type(&profile);
+        }
+    }
+  
+    ql_qmap_mode_detect(&profile);
+
+    if (profile.software_interface == SOFTWARE_MBIM) {
+        dbg_time("Modem works in MBIM mode");
+        ret = mbim_main(&profile);
+    } else if (profile.software_interface == SOFTWARE_QMI) {
+        dbg_time("Modem works in QMI mode");
+        ret = qmi_main(&profile);
+    }
+
+    ql_stop_usbmon_log(&profile);
+    if (logfilefp)
+    fclose(logfilefp);
+
+error:
+
+    return ret;
+}

root/package/link4all/quectel-CM/quectel1.6.0.15_src/qmap_bridge_mode.c

@@ -0,0 +1,409 @@
+/******************************************************************************
+  @file    qmap_bridge_mode.c
+  @brief   Connectivity bridge manager.
+
+  DESCRIPTION
+  Connectivity Management Tool for USB network adapter of Quectel wireless cellular modules.
+
+  INITIALIZATION AND SEQUENCING REQUIREMENTS
+  None.
+
+  ---------------------------------------------------------------------------
+  Copyright (c) 2016 - 2020 Quectel Wireless Solution, Co., Ltd.  All Rights Reserved.
+  Quectel Wireless Solution Proprietary and Confidential.
+  ---------------------------------------------------------------------------
+******************************************************************************/
+#include "QMIThread.h"
+
+static size_t ql_fread(const char *filename, void *buf, size_t size) {
+    FILE *fp = fopen(filename , "r");
+    size_t n = 0;
+
+    memset(buf, 0x00, size);
+
+    if (fp) {
+        n = fread(buf, 1, size, fp);
+        if (n <= 0 || n == size) {
+            dbg_time("warnning: fail to fread(%s), fread=%zu, buf_size=%zu: (%s)", filename, n, size, strerror(errno));
+        }
+        fclose(fp);
+    }
+
+    return n > 0 ? n : 0;
+}
+
+static size_t ql_fwrite(const char *filename, const void *buf, size_t size) {
+    FILE *fp = fopen(filename , "w");
+    size_t n = 0;
+
+    if (fp) {
+        n = fwrite(buf, 1, size, fp);
+        if (n != size) {
+            dbg_time("warnning: fail to fwrite(%s), fwrite=%zu, buf_size=%zu: (%s)", filename, n, size, strerror(errno));
+        }
+        fclose(fp);
+    }
+
+    return n > 0 ? n : 0;
+}
+
+int ql_bridge_mode_detect(PROFILE_T *profile) {
+    const char *ifname = profile->qmapnet_adapter ? profile->qmapnet_adapter : profile->usbnet_adapter;
+    const char *driver;
+    char bridge_mode[128];
+    char bridge_ipv4[128];
+    char ipv4[128];
+    char buf[64];
+    size_t n;
+    int in_bridge = 0;
+
+    driver = profile->driver_name;
+    snprintf(bridge_mode, sizeof(bridge_mode), "/sys/class/net/%s/bridge_mode", ifname);
+    snprintf(bridge_ipv4, sizeof(bridge_ipv4), "/sys/class/net/%s/bridge_ipv4", ifname);
+
+    if (access(bridge_ipv4, R_OK)) {
+        if (errno != ENOENT) {
+            dbg_time("fail to access %s, errno: %d (%s)", bridge_mode, errno, strerror(errno));
+            return 0;
+        }
+
+        snprintf(bridge_mode, sizeof(bridge_mode), "/sys/module/%s/parameters/bridge_mode", driver);
+        snprintf(bridge_ipv4, sizeof(bridge_ipv4), "/sys/module/%s/parameters/bridge_ipv4", driver);
+
+        if (access(bridge_mode, R_OK)) {
+            if (errno != ENOENT) {
+                dbg_time("fail to access %s, errno: %d (%s)", bridge_mode, errno, strerror(errno));
+            }
+            return 0;
+        }
+    }
+
+    n = ql_fread(bridge_mode, buf, sizeof(buf));
+    if (n > 0) {
+        in_bridge = (buf[0] != '0');
+    }
+    if (!in_bridge)
+        return 0;
+   
+    memset(ipv4, 0, sizeof(ipv4));
+
+    if (strstr(bridge_ipv4, "/sys/class/net/") || profile->qmap_mode == 0 || profile->qmap_mode == 1) {
+        snprintf(ipv4, sizeof(ipv4), "0x%x", profile->ipv4.Address);
+        dbg_time("echo '%s' > %s", ipv4, bridge_ipv4);
+        ql_fwrite(bridge_ipv4, ipv4, strlen(ipv4));
+    }
+    else {
+        snprintf(ipv4, sizeof(ipv4), "0x%x:%d", profile->ipv4.Address, profile->muxid);
+        dbg_time("echo '%s' > %s", ipv4, bridge_ipv4);
+        ql_fwrite(bridge_ipv4, ipv4, strlen(ipv4));
+    }
+
+    return in_bridge;
+}
+
+int ql_enable_qmi_wwan_rawip_mode(PROFILE_T *profile) {
+    char filename[256];
+    char buf[4];
+    size_t n;
+    FILE *fp;
+
+    if (!qmidev_is_qmiwwan(profile->qmichannel))
+        return 0;
+
+    snprintf(filename, sizeof(filename), "/sys/class/net/%s/qmi/rawip", profile->usbnet_adapter);
+    n = ql_fread(filename, buf, sizeof(buf));
+
+    if (n == 0)
+        return 0;
+
+    if (buf[0] == '1' || buf[0] == 'Y')
+        return 0;
+
+    fp = fopen(filename , "w");
+    if (fp == NULL) {
+        dbg_time("Fail to fopen(%s, \"w\"), errno: %d (%s)", filename, errno, strerror(errno));
+        return 1;
+    }
+
+    buf[0] = 'Y';
+    n = fwrite(buf, 1, 1, fp);
+    if (n != 1) {
+        dbg_time("Fail to fwrite(%s), errno: %d (%s)", filename, errno, strerror(errno));
+        fclose(fp);
+        return 1;
+    }
+    fclose(fp);
+
+    return 0;
+}
+
+int ql_driver_type_detect(PROFILE_T *profile) {
+    if (qmidev_is_gobinet(profile->qmichannel)) {
+        profile->qmi_ops = &gobi_qmidev_ops;
+    }
+    else {
+        profile->qmi_ops = &qmiwwan_qmidev_ops;
+    }
+    qmidev_send = profile->qmi_ops->send;
+
+    return 0;
+}
+
+void ql_set_driver_bridge_mode(PROFILE_T *profile) {
+    char enable[8];
+    char filename[256];
+
+    if(profile->qmap_mode)
+        snprintf(filename, sizeof(filename), "/sys/class/net/%s/bridge_mode", profile->qmapnet_adapter);
+    else
+        snprintf(filename, sizeof(filename), "/sys/class/net/%s/bridge_mode", profile->usbnet_adapter);
+    snprintf(enable, sizeof(enable), "%d\n", profile->enable_bridge);
+    ql_fwrite(filename, enable, sizeof(enable));
+}
+
+static int ql_qmi_qmap_mode_detect(PROFILE_T *profile) {
+    char buf[128];
+    int n;
+    char qmap_netcard[128];
+    struct {
+        char filename[255 * 2];
+        char linkname[255 * 2];
+    } *pl;
+
+    pl = (typeof(pl)) malloc(sizeof(*pl));
+
+    if (profile->qmapnet_adapter) {
+        free(profile->qmapnet_adapter);;
+        profile->qmapnet_adapter = NULL;
+    }
+
+    snprintf(pl->linkname, sizeof(pl->linkname), "/sys/class/net/%s/device/driver", profile->usbnet_adapter);
+    n = readlink(pl->linkname, pl->filename, sizeof(pl->filename));
+    pl->filename[n] = '\0';
+    while (pl->filename[n] != '/')
+        n--;
+    strset(profile->driver_name, &pl->filename[n+1]);
+
+    ql_get_driver_rmnet_info(profile, &profile->rmnet_info);
+    if (profile->rmnet_info.size) {
+        profile->qmap_mode = profile->rmnet_info.qmap_mode;
+        if (profile->qmap_mode) {
+            int offset_id = profile->pdp - 1;
+
+            if (profile->qmap_mode == 1)
+                offset_id = 0;
+            profile->muxid = profile->rmnet_info.mux_id[offset_id];
+            profile->qmapnet_adapter = strdup( profile->rmnet_info.ifname[offset_id]);
+            profile->qmap_size = profile->rmnet_info.rx_urb_size;
+            profile->qmap_version = profile->rmnet_info.qmap_version;
+        }
+
+        goto _out;
+    }
+
+    snprintf(pl->filename, sizeof(pl->filename), "/sys/class/net/%s/qmap_mode", profile->usbnet_adapter);
+    if (access(pl->filename, R_OK)) {
+        if (errno != ENOENT) {
+            dbg_time("fail to access %s, errno: %d (%s)", pl->filename, errno, strerror(errno));
+            goto _out;
+        }
+        
+        snprintf(pl->filename, sizeof(pl->filename), "/sys/module/%s/parameters/qmap_mode", profile->driver_name);
+        if (access(pl->filename, R_OK)) {
+            if (errno != ENOENT) {
+                dbg_time("fail to access %s, errno: %d (%s)", pl->filename, errno, strerror(errno));
+                goto _out;
+            }
+            
+            snprintf(pl->filename, sizeof(pl->filename), "/sys/class/net/%s/device/driver/module/parameters/qmap_mode", profile->usbnet_adapter);
+            if (access(pl->filename, R_OK)) {
+                if (errno != ENOENT) {
+                    dbg_time("fail to access %s, errno: %d (%s)", pl->filename, errno, strerror(errno));
+                    goto _out;
+                }
+            }
+        }
+    }
+
+    if (!access(pl->filename, R_OK)) {
+        n = ql_fread(pl->filename, buf, sizeof(buf));
+        if (n > 0) {
+            profile->qmap_mode = atoi(buf);
+            
+            if (profile->qmap_mode > 1) {
+                profile->muxid = profile->pdp + 0x80; //muxis is 0x8X for PDN-X
+                sprintf(qmap_netcard, "%s.%d", profile->usbnet_adapter, profile->pdp);
+                profile->qmapnet_adapter = strdup(qmap_netcard);
+           } if (profile->qmap_mode == 1) {
+                profile->muxid = 0x81;
+                profile->qmapnet_adapter = strdup(profile->usbnet_adapter);
+           }
+        }
+    }
+    else if (qmidev_is_qmiwwan(profile->qmichannel)) {
+        snprintf(pl->filename, sizeof(pl->filename), "/sys/class/net/qmimux%d", profile->pdp - 1);
+        if (access(pl->filename, R_OK)) {
+            if (errno != ENOENT) {
+                dbg_time("fail to access %s, errno: %d (%s)", pl->filename, errno, strerror(errno));
+            }
+            goto _out;
+        }
+
+        //upstream Kernel Style QMAP qmi_wwan.c
+        snprintf(pl->filename, sizeof(pl->filename), "/sys/class/net/%s/qmi/add_mux", profile->usbnet_adapter);
+        n = ql_fread(pl->filename, buf, sizeof(buf));
+        if (n >= 5) {
+            dbg_time("If use QMAP by /sys/class/net/%s/qmi/add_mux", profile->usbnet_adapter);
+            dbg_time("File:%s Line:%d Please make sure add next patch to qmi_wwan.c", __func__, __LINE__);
+            /*
+            diff --git a/drivers/net/usb/qmi_wwan.c b/drivers/net/usb/qmi_wwan.c
+            index 74bebbd..db8a777 100644
+            --- a/drivers/net/usb/qmi_wwan.c
+            +++ b/drivers/net/usb/qmi_wwan.c
+            @@ -379,6 +379,24 @@ static ssize_t add_mux_store(struct device *d,  struct device_attribute *attr, c
+                if (!ret) {
+                        info->flags |= QMI_WWAN_FLAG_MUX;
+                        ret = len;
+            +#if 1 //Add by Quectel
+            +               if (le16_to_cpu(dev->udev->descriptor.idVendor) == 0x2c7c) {
+            +                       int idProduct = le16_to_cpu(dev->udev->descriptor.idProduct);
+            +
+            +                       if (idProduct == 0x0121 || idProduct == 0x0125 || idProduct == 0x0435) //MDM9x07
+            +                               dev->rx_urb_size = 4*1024;
+            +                       else if (idProduct == 0x0306) //MDM9x40
+            +                               dev->rx_urb_size = 16*1024;
+            +                       else if (idProduct == 0x0512) //SDX20
+            +                               dev->rx_urb_size = 32*1024;
+            +                       else if (idProduct == 0x0620) //SDX24
+            +                               dev->rx_urb_size = 32*1024;
+            +                       else if (idProduct == 0x0800) //SDX55
+            +                               dev->rx_urb_size = 32*1024;
+            +                       else
+            +                               dev->rx_urb_size = 32*1024;
+            +               }
+            +#endif
+                }
+            err:
+                rtnl_unlock();
+            */
+            profile->qmap_mode = n/5; //0x11\n0x22\n0x33\n
+            if (profile->qmap_mode > 1) {
+                //PDN-X map to qmimux-X
+                profile->muxid = (buf[5*(profile->pdp - 1) + 2] - '0')*16 + (buf[5*(profile->pdp - 1) + 3] - '0');
+                sprintf(qmap_netcard, "qmimux%d", profile->pdp - 1);
+                profile->qmapnet_adapter = strdup(qmap_netcard);
+            } else if (profile->qmap_mode == 1) {
+                profile->muxid = (buf[5*0 + 2] - '0')*16 + (buf[5*0 + 3] - '0');
+                sprintf(qmap_netcard, "qmimux%d", 0);
+                profile->qmapnet_adapter = strdup(qmap_netcard);
+            }
+        }
+    } 
+
+_out:
+    if (profile->qmap_mode) {
+        if (profile->qmap_size == 0) {
+            profile->qmap_size = 16*1024;
+            snprintf(pl->filename, sizeof(pl->filename), "/sys/class/net/%s/qmap_size", profile->usbnet_adapter);
+            if (!access(pl->filename, R_OK)) {
+                size_t n;
+                char buf[32];
+                n = ql_fread(pl->filename, buf, sizeof(buf));
+                if (n > 0) {
+                    profile->qmap_size = atoi(buf);
+                }
+            }
+        }
+
+        if (profile->qmap_version == 0) {
+            profile->qmap_version = WDA_DL_DATA_AGG_QMAP_ENABLED;
+        }
+
+        dbg_time("qmap_mode = %d, qmap_version = %d, qmap_size = %d, muxid = 0x%02x, qmap_netcard = %s",
+            profile->qmap_mode, profile->qmap_version, profile->qmap_size, profile->muxid, profile->qmapnet_adapter);
+    }
+    ql_set_driver_bridge_mode(profile);
+    free(pl);
+
+    return 0;
+}
+
+
+static int ql_mbim_qmap_mode_detect(PROFILE_T *profile) {
+    char buf[128];
+    int n;
+    char qmap_netcard[128];
+    struct {
+        char filename[255 * 2];
+        char linkname[255 * 2];
+    } *pl;
+    
+    pl = (typeof(pl)) malloc(sizeof(*pl));
+
+    if (profile->qmapnet_adapter) {
+        free(profile->qmapnet_adapter);;
+        profile->qmapnet_adapter = NULL;
+    }
+
+    snprintf(pl->linkname, sizeof(pl->linkname), "/sys/class/net/%s/device/driver", profile->usbnet_adapter);
+    n = readlink(pl->linkname, pl->filename, sizeof(pl->filename));
+    pl->filename[n] = '\0';
+    while (pl->filename[n] != '/')
+        n--;
+    strset(profile->driver_name, &pl->filename[n+1]);
+
+    ql_get_driver_rmnet_info(profile, &profile->rmnet_info);
+    if (profile->rmnet_info.size) {
+        profile->qmap_mode = profile->rmnet_info.qmap_mode;
+        if (profile->qmap_mode) {
+            int offset_id = profile->pdp - 1;
+
+            if (profile->qmap_mode == 1)
+                offset_id = 0;
+            profile->muxid = profile->rmnet_info.mux_id[offset_id];
+            profile->qmapnet_adapter = strdup( profile->rmnet_info.ifname[offset_id]);
+            profile->qmap_size = profile->rmnet_info.rx_urb_size;
+            profile->qmap_version = profile->rmnet_info.qmap_version;
+        }
+
+        goto _out;
+    }
+
+    snprintf(pl->filename, sizeof(pl->filename), "/sys/module/%s/parameters/qmap_mode", profile->driver_name);
+    if (access(pl->filename, R_OK)) {
+        if (errno != ENOENT) {
+            dbg_time("fail to access %s, errno: %d (%s)", pl->filename, errno, strerror(errno));
+            goto _out;
+        }
+    } else {
+        n = ql_fread(pl->filename, buf, sizeof(buf));
+        if (n > 0) {
+            profile->qmap_mode = atoi(buf);
+            
+            if (profile->qmap_mode > 1) {
+                profile->muxid = profile->pdp + 0x80; //muxis is 0x8X for PDN-X
+                sprintf(qmap_netcard, "%s.%d", profile->usbnet_adapter, profile->pdp);
+                profile->qmapnet_adapter = strdup(qmap_netcard);
+            }
+        }
+    }
+
+_out:
+    if (profile->qmap_mode) {
+        dbg_time("mbim_qmap_mode = %d, vlan_id = 0x%02x, qmap_netcard = %s",
+            profile->qmap_mode, profile->muxid, profile->qmapnet_adapter);
+    }
+
+    free(pl);
+
+    return 0;
+}
+
+int ql_qmap_mode_detect(PROFILE_T *profile) {
+    if (profile->software_interface == SOFTWARE_MBIM) {
+        return ql_mbim_qmap_mode_detect(profile);
+    } else if (profile->software_interface == SOFTWARE_QMI) {
+        return ql_qmi_qmap_mode_detect(profile);
+    }
+	return 0;
+}

root/package/link4all/quectel-CM/quectel1.6.0.15_src/udhcpc.c

@@ -0,0 +1,675 @@
+/******************************************************************************
+  @file    udhcpc.c
+  @brief   call DHCP tools to obtain IP address.
+
+  DESCRIPTION
+  Connectivity Management Tool for USB network adapter of Quectel wireless cellular modules.
+
+  INITIALIZATION AND SEQUENCING REQUIREMENTS
+  None.
+
+  ---------------------------------------------------------------------------
+  Copyright (c) 2016 - 2020 Quectel Wireless Solution, Co., Ltd.  All Rights Reserved.
+  Quectel Wireless Solution Proprietary and Confidential.
+  ---------------------------------------------------------------------------
+******************************************************************************/
+#include <sys/socket.h>
+#include <sys/select.h>
+#include <sys/types.h>
+#include <net/if.h>
+#include <sys/socket.h>
+#include <netinet/in.h>
+#include <arpa/inet.h>
+#include <endian.h>
+
+#include "util.h"
+#include "QMIThread.h"
+
+static int ql_system(const char *shell_cmd) {
+    dbg_time("%s", shell_cmd);
+    return system(shell_cmd);
+}
+
+static void ifc_init_ifr(const char *name, struct ifreq *ifr)
+{
+    memset(ifr, 0, sizeof(struct ifreq));
+    strncpy(ifr->ifr_name, name, IFNAMSIZ);
+    ifr->ifr_name[IFNAMSIZ - 1] = 0;
+}
+
+static void ql_set_mtu(const char *ifname, int ifru_mtu) {
+    int inet_sock;
+    struct ifreq ifr;
+
+    inet_sock = socket(AF_INET, SOCK_DGRAM, 0);
+
+    if (inet_sock > 0) {
+        ifc_init_ifr(ifname, &ifr);
+
+        if (!ioctl(inet_sock, SIOCGIFMTU, &ifr)) {
+            if (ifr.ifr_ifru.ifru_mtu != ifru_mtu) {
+                dbg_time("change mtu %d -> %d", ifr.ifr_ifru.ifru_mtu , ifru_mtu);
+                ifr.ifr_ifru.ifru_mtu = ifru_mtu;
+                ioctl(inet_sock, SIOCSIFMTU, &ifr);
+            }
+        }
+
+        close(inet_sock);
+    }
+}
+
+static int ifc_get_addr(const char *name, in_addr_t *addr)
+{
+    int inet_sock;
+    struct ifreq ifr;
+    int ret = 0;
+
+    inet_sock = socket(AF_INET, SOCK_DGRAM, 0);
+
+    ifc_init_ifr(name, &ifr);
+    if (addr != NULL) {
+        ret = ioctl(inet_sock, SIOCGIFADDR, &ifr);
+        if (ret < 0) {
+            *addr = 0;
+        } else {
+            *addr = ((struct sockaddr_in*) &ifr.ifr_addr)->sin_addr.s_addr;
+        }
+    }
+    close(inet_sock);
+    return ret;
+}
+
+static short ifc_get_flags(const char *ifname)
+{
+    int inet_sock;
+    struct ifreq ifr;
+    int ret = 0;
+
+    inet_sock = socket(AF_INET, SOCK_DGRAM, 0);
+
+    if (inet_sock > 0) {
+        ifc_init_ifr(ifname, &ifr);
+
+        if (!ioctl(inet_sock, SIOCGIFFLAGS, &ifr)) {
+            ret = ifr.ifr_ifru.ifru_flags;
+        }
+
+        close(inet_sock);
+    }
+
+    return ret;
+}
+
+static int ql_raw_ip_mode_check(const char *ifname) {
+    int fd;
+    in_addr_t addr;
+    char raw_ip[128];
+    char shell_cmd[128];
+    char mode[2] = "X";
+    int mode_change = 0;
+
+    ifc_get_addr(ifname, &addr);
+    if (addr)
+        return 0;
+    
+    snprintf(raw_ip, sizeof(raw_ip), "/sys/class/net/%s/qmi/raw_ip", ifname);
+    if (access(raw_ip, F_OK))
+        return 0;
+
+    fd = open(raw_ip, O_RDWR | O_NONBLOCK | O_NOCTTY);
+    if (fd < 0) {
+        dbg_time("%s %d fail to open(%s), errno:%d (%s)", __FILE__, __LINE__, raw_ip, errno, strerror(errno));
+        return 0;
+    }
+
+    read(fd, mode, 2);
+    if (mode[0] == '0' || mode[0] == 'N') {
+        dbg_time("File:%s Line:%d udhcpc fail to get ip address, try next:", __func__, __LINE__);
+        snprintf(shell_cmd, sizeof(shell_cmd), "ifconfig %s down", ifname);
+        ql_system(shell_cmd);
+        dbg_time("echo Y > /sys/class/net/%s/qmi/raw_ip", ifname);
+        mode[0] = 'Y';
+        write(fd, mode, 2);
+        mode_change = 1;
+        snprintf(shell_cmd, sizeof(shell_cmd), "ifconfig %s up", ifname);
+        ql_system(shell_cmd);
+    }
+
+    close(fd);
+    return mode_change;
+}
+
+static void* udhcpc_thread_function(void* arg) {
+    FILE * udhcpc_fp;
+    char *udhcpc_cmd = (char *)arg;
+
+    if (udhcpc_cmd == NULL)
+        return NULL;
+
+    dbg_time("%s", udhcpc_cmd);
+    udhcpc_fp = popen(udhcpc_cmd, "r");
+    free(udhcpc_cmd);
+    if (udhcpc_fp) {
+        char buf[0xff];
+
+        buf[sizeof(buf)-1] = '\0';
+        while((fgets(buf, sizeof(buf)-1, udhcpc_fp)) != NULL) {
+            if ((strlen(buf) > 1) && (buf[strlen(buf) - 1] == '\n'))
+                buf[strlen(buf) - 1] = '\0';
+            dbg_time("%s", buf);
+        }
+
+        pclose(udhcpc_fp);
+    }
+
+    return NULL;
+}
+
+//#define USE_DHCLIENT
+#ifdef USE_DHCLIENT
+static int dhclient_alive = 0;
+#endif
+static int dibbler_client_alive = 0;
+
+void ql_get_driver_rmnet_info(PROFILE_T *profile, RMNET_INFO *rmnet_info) {
+    int ifc_ctl_sock;
+    struct ifreq ifr;
+    int rc;
+    int request = 0x89F3;
+    unsigned char data[512];
+
+    memset(rmnet_info, 0x00, sizeof(*rmnet_info));
+
+    ifc_ctl_sock = socket(AF_INET, SOCK_DGRAM, 0);
+    if (ifc_ctl_sock <= 0) {
+        dbg_time("socket() failed: %s\n", strerror(errno));
+        return;
+    }
+    
+    memset(&ifr, 0, sizeof(struct ifreq));
+    strncpy(ifr.ifr_name, profile->usbnet_adapter, IFNAMSIZ);
+    ifr.ifr_name[IFNAMSIZ - 1] = 0;    
+    ifr.ifr_ifru.ifru_data = (void *)data;
+        
+    rc = ioctl(ifc_ctl_sock, request, &ifr);
+    if (rc < 0) {
+        dbg_time("ioctl(0x%x, qmap_settings) failed: %s, rc=%d", request, strerror(errno), rc);
+    }
+    else {
+        memcpy(rmnet_info, data, sizeof(*rmnet_info));
+    }
+
+    close(ifc_ctl_sock);
+}
+
+void ql_set_driver_qmap_setting(PROFILE_T *profile, QMAP_SETTING *qmap_settings) {
+    int ifc_ctl_sock;
+    struct ifreq ifr;
+    int rc;
+    int request = 0x89F2;
+
+    ifc_ctl_sock = socket(AF_INET, SOCK_DGRAM, 0);
+    if (ifc_ctl_sock <= 0) {
+        dbg_time("socket() failed: %s\n", strerror(errno));
+        return;
+    }
+    
+    memset(&ifr, 0, sizeof(struct ifreq));
+    strncpy(ifr.ifr_name, profile->usbnet_adapter, IFNAMSIZ);
+    ifr.ifr_name[IFNAMSIZ - 1] = 0;    
+    ifr.ifr_ifru.ifru_data = (void *)qmap_settings;
+        
+    rc = ioctl(ifc_ctl_sock, request, &ifr);
+    if (rc < 0) {
+        dbg_time("ioctl(0x%x, qmap_settings) failed: %s, rc=%d", request, strerror(errno), rc);
+    }
+
+    close(ifc_ctl_sock);	
+}
+
+void ql_set_driver_link_state(PROFILE_T *profile, int link_state) {
+    char link_file[128];
+    int fd;
+    int new_state = 0;
+
+    snprintf(link_file, sizeof(link_file), "/sys/class/net/%s/link_state", profile->usbnet_adapter);
+    fd = open(link_file, O_RDWR | O_NONBLOCK | O_NOCTTY);
+    if (fd == -1) {
+        if (errno != ENOENT)
+            dbg_time("Fail to access %s, errno: %d (%s)", link_file, errno, strerror(errno));
+        return;
+    }
+
+    if (profile->qmap_mode <= 1)
+        new_state = !!link_state;
+    else {
+        //0x80 means link off this pdp
+        new_state = (link_state ? 0x00 : 0x80) + profile->pdp;
+    }
+
+    snprintf(link_file, sizeof(link_file), "%d\n", new_state);
+    write(fd, link_file, sizeof(link_file));
+
+    if (link_state == 0 && profile->qmapnet_adapter && strcmp(profile->qmapnet_adapter, profile->usbnet_adapter)) {
+        size_t rc;
+
+        lseek(fd, 0, SEEK_SET);
+        rc = read(fd, link_file, sizeof(link_file));
+        if (rc > 1 && (!strncasecmp(link_file, "0\n", 2) || !strncasecmp(link_file, "0x0\n", 4))) {
+            snprintf(link_file, sizeof(link_file), "ifconfig %s down", profile->usbnet_adapter);
+            ql_system(link_file);
+        }
+    }
+
+    close(fd);
+}
+
+static const char *ipv4Str(const uint32_t Address) {
+    static char str[] = {"255.225.255.255"};
+    uint8_t *ip = (uint8_t *)&Address;
+
+    snprintf(str, sizeof(str), "%d.%d.%d.%d", ip[3], ip[2], ip[1], ip[0]);
+    return str;
+}
+
+static const char *ipv6Str(const UCHAR Address[16]) {
+    static char str[64];
+    uint16_t ip[8];
+    int i;
+    for (i = 0; i < 8; i++) {
+        ip[i] = (Address[i*2]<<8) + Address[i*2+1];
+    }
+
+    snprintf(str, sizeof(str), "%x:%x:%x:%x:%x:%x:%x:%x",
+        ip[0], ip[1], ip[2], ip[3], ip[4], ip[5], ip[6], ip[7]);
+
+    return str;
+}
+
+//#define QL_OPENWER_NETWORK_SETUP
+#ifdef QL_OPENWER_NETWORK_SETUP
+static const char *openwrt_lan = "br-lan";
+static const char *openwrt_wan = "wwan0";
+
+static int ql_openwrt_system(const char *cmd) {
+    int i;
+    int ret = 1;
+    char shell_cmd[128];
+
+    snprintf(shell_cmd, sizeof(shell_cmd), "%s 2>1 > /dev/null", cmd);
+    
+    for (i = 0; i < 15; i++) {
+        dbg_time("%s", cmd);
+        ret = system(shell_cmd);
+        if (!ret)
+            break;
+        sleep(1);
+    }
+
+    return ret;
+}
+
+static int ql_openwrt_is_wan(const char *ifname) {
+    if (openwrt_lan == NULL) {
+        system("uci show network.wan.ifname");
+    }
+
+    if (strcmp(ifname, openwrt_wan))
+        return 0;
+
+    return 1;
+}
+
+static void ql_openwrt_setup_wan(const char *ifname, const IPV4_T *ipv4) {
+    FILE *fp = NULL;
+    char config[64];
+
+    snprintf(config, sizeof(config), "/tmp/rmnet_%s_ipv4config", ifname);
+     
+    if (ipv4 == NULL) {
+        if (ql_openwrt_is_wan(ifname))
+            ql_openwrt_system("ifdown wan");
+        return;
+    }
+
+    fp = fopen(config, "w");
+    if (fp == NULL)
+        return;
+
+    fprintf(fp, "IFNAME=\"%s\"\n", ifname);
+    fprintf(fp, "PUBLIC_IP=\"%s\"\n", ipv4Str(ipv4->Address));
+    fprintf(fp, "NETMASK=\"%s\"\n", ipv4Str(ipv4->SubnetMask));
+    fprintf(fp, "GATEWAY=\"%s\"\n", ipv4Str(ipv4->Gateway));
+    fprintf(fp, "DNSSERVERS=\"%s", ipv4Str(ipv4->DnsPrimary));
+    if (ipv4->DnsSecondary != 0)
+        fprintf(fp, " %s", ipv4Str(ipv4->DnsSecondary));
+    fprintf(fp, "\"\n");
+
+    fclose(fp);
+
+    if (!ql_openwrt_is_wan(ifname))
+        return;
+    
+    ql_openwrt_system("ifup wan");
+}
+
+static void ql_openwrt_setup_wan6(const char *ifname, const IPV6_T *ipv6) {
+    FILE *fp = NULL;
+    char config[64];
+    int first_ifup;
+     
+    snprintf(config, sizeof(config), "/tmp/rmnet_%s_ipv6config", ifname);
+     
+    if (ipv6 == NULL) {
+        if (ql_openwrt_is_wan(ifname))
+            ql_openwrt_system("ifdown wan6");
+        return;
+    }
+
+    first_ifup = (access(config, F_OK) != 0);
+
+    fp = fopen(config, "w");
+    if (fp == NULL)
+        return;
+
+    fprintf(fp, "IFNAME=\"%s\"\n", ifname);
+    fprintf(fp, "PUBLIC_IP=\"%s\"\n", ipv6Str(ipv6->Address));
+    fprintf(fp, "NETMASK=\"%s\"\n", ipv6Str(ipv6->SubnetMask));
+    fprintf(fp, "GATEWAY=\"%s\"\n", ipv6Str(ipv6->Gateway));
+    fprintf(fp, "PrefixLength=\"%d\"\n", ipv6->PrefixLengthIPAddr);
+    fprintf(fp, "DNSSERVERS=\"%s", ipv6Str(ipv6->DnsPrimary));
+    if (ipv6->DnsSecondary[0])
+        fprintf(fp, " %s", ipv6Str(ipv6->DnsSecondary));
+    fprintf(fp, "\"\n");
+
+    fclose(fp);
+
+    if (!ql_openwrt_is_wan(ifname))
+        return;
+
+    if (first_ifup)
+        ql_openwrt_system("ifup wan6");
+    else
+        ql_openwrt_system("/etc/init.d/network restart"); //make PC to release old IPV6 address, and RS new IPV6 address
+
+#if 1 //TODO? why need this?
+    if (openwrt_lan) {
+        int i;
+        char shell_cmd[128];
+        UCHAR Address[16] = {0};
+
+        ql_openwrt_system(("ifstatus lan"));
+
+        for (i = 0; i < (ipv6->PrefixLengthIPAddr/8); i++)
+            Address[i] = ipv6->Address[i];
+
+        snprintf(shell_cmd, sizeof(shell_cmd), "ip route del %s/%u dev %s", ipv6Str(Address), ipv6->PrefixLengthIPAddr, ifname);
+        ql_openwrt_system(shell_cmd);
+
+        snprintf(shell_cmd, sizeof(shell_cmd), "ip route add %s/%u dev %s", ipv6Str(Address), ipv6->PrefixLengthIPAddr, openwrt_lan);
+        ql_system(shell_cmd);        
+    }
+#endif
+}
+#endif
+
+void udhcpc_start(PROFILE_T *profile) {
+    char *ifname = profile->usbnet_adapter;
+    char shell_cmd[128];
+
+    ql_set_driver_link_state(profile, 1);
+
+    if (profile->qmapnet_adapter) {
+        ifname = profile->qmapnet_adapter;
+    }
+
+    if (profile->rawIP && profile->ipv4.Address && profile->ipv4.Mtu) {
+        ql_set_mtu(ifname, (profile->ipv4.Mtu));
+    }
+
+    if (strcmp(ifname, profile->usbnet_adapter)) {
+        snprintf(shell_cmd, sizeof(shell_cmd), "ifconfig %s up", profile->usbnet_adapter);
+        ql_system(shell_cmd);
+        if (ifc_get_flags(ifname)&IFF_UP) {
+            snprintf(shell_cmd, sizeof(shell_cmd), "ifconfig %s down", ifname);
+            ql_system(shell_cmd);
+        }
+    }
+
+    snprintf(shell_cmd, sizeof(shell_cmd), "ifconfig %s up", ifname);
+    ql_system(shell_cmd);
+	
+    if (profile->ipv4.Address) {
+        if (profile->PCSCFIpv4Addr1)
+            dbg_time("pcscf1: %s", ipv4Str(profile->PCSCFIpv4Addr1));
+        if (profile->PCSCFIpv4Addr2)
+            dbg_time("pcscf2: %s", ipv4Str(profile->PCSCFIpv4Addr2));
+    }
+
+    if (profile->ipv6.Address[0] && profile->ipv6.PrefixLengthIPAddr) {
+        if (profile->PCSCFIpv6Addr1[0])
+            dbg_time("pcscf1: %s", ipv6Str(profile->PCSCFIpv6Addr1));
+        if (profile->PCSCFIpv6Addr2[0])
+            dbg_time("pcscf2: %s", ipv6Str(profile->PCSCFIpv6Addr2));
+    }
+
+#if 1 //for bridge mode, only one public IP, so do udhcpc manually
+    if (ql_bridge_mode_detect(profile)) {
+        return;
+    }
+#endif
+
+//because must use udhcpc to obtain IP when working on ETH mode,
+//so it is better also use udhcpc to obtain IP when working on IP mode.
+//use the same policy for all modules
+#if 0
+    if (profile->rawIP != 0) //mdm9x07/ec25,ec20 R2.0
+    {
+        if (profile->ipv4.Address) {
+            unsigned char *ip = (unsigned char *)&profile->ipv4.Address;
+            unsigned char *gw = (unsigned char *)&profile->ipv4.Gateway;
+            unsigned char *netmask = (unsigned char *)&profile->ipv4.SubnetMask;
+            unsigned char *dns1 = (unsigned char *)&profile->ipv4.DnsPrimary;
+            unsigned char *dns2 = (unsigned char *)&profile->ipv4.DnsSecondary;
+
+            snprintf(shell_cmd, sizeof(shell_cmd), "ifconfig %s %d.%d.%d.%d netmask %d.%d.%d.%d",ifname,
+                ip[3], ip[2], ip[1], ip[0], netmask[3], netmask[2], netmask[1], netmask[0]);
+            ql_system(shell_cmd);
+
+            //Resetting default routes
+            snprintf(shell_cmd, sizeof(shell_cmd), "route del default gw 0.0.0.0 dev %s", ifname);
+            while(!system(shell_cmd));
+
+            snprintf(shell_cmd, sizeof(shell_cmd), "route add default gw %d.%d.%d.%d dev %s metric 0", gw[3], gw[2], gw[1], gw[0], ifname);
+            ql_system(shell_cmd);
+
+            //Adding DNS
+            if (profile->ipv4.DnsSecondary == 0)
+                profile->ipv4.DnsSecondary = profile->ipv4.DnsPrimary;
+
+            if (dns1[0]) {
+                dbg_time("Adding DNS %d.%d.%d.%d %d.%d.%d.%d", dns1[3], dns1[2], dns1[1], dns1[0], dns2[3], dns2[2], dns2[1], dns2[0]);
+                snprintf(shell_cmd, sizeof(shell_cmd), "echo -n \"nameserver %d.%d.%d.%d\nnameserver %d.%d.%d.%d\n\" > /etc/resolv.conf",
+                    dns1[3], dns1[2], dns1[1], dns1[0], dns2[3], dns2[2], dns2[1], dns2[0]);
+                system(shell_cmd);
+            }
+        }
+
+
+        if (profile->ipv6.Address[0] && profile->ipv6.PrefixLengthIPAddr) {
+            unsigned char *ip = (unsigned char *)profile->ipv6.Address;
+#if 1
+            snprintf(shell_cmd, sizeof(shell_cmd), "ifconfig %s inet6 add %02x%02x:%02x%02x:%02x%02x:%02x%02x:%02x%02x:%02x%02x/%d",
+                ifname, ip[0], ip[1], ip[2], ip[3], ip[4], ip[5], ip[6], ip[7], ip[8], ip[9], ip[10], ip[11], ip[12], ip[13], ip[14], ip[15], profile->ipv6.PrefixLengthIPAddr);
+#else
+            snprintf(shell_cmd, sizeof(shell_cmd), "ip -6 addr add %02x%02x:%02x%02x:%02x%02x:%02x%02x:%02x%02x:%02x%02x/%d dev %s",
+                ip[0], ip[1], ip[2], ip[3], ip[4], ip[5], ip[6], ip[7], ip[8], ip[9], ip[10], ip[11], ip[12], ip[13], ip[14], ip[15], profile->ipv6.PrefixLengthIPAddr, ifname);
+#endif
+            ql_system(shell_cmd);
+            snprintf(shell_cmd, sizeof(shell_cmd), "route -A inet6 add default dev %s", ifname);
+            ql_system(shell_cmd);
+        }
+        return;
+    }
+#endif
+
+/* Do DHCP using busybox tools */
+    {
+        char udhcpc_cmd[128];
+        pthread_attr_t udhcpc_thread_attr;
+        pthread_t udhcpc_thread_id;
+
+        pthread_attr_init(&udhcpc_thread_attr);
+        pthread_attr_setdetachstate(&udhcpc_thread_attr, PTHREAD_CREATE_DETACHED);
+
+        if (profile->ipv4.Address) {
+#ifdef USE_DHCLIENT
+            snprintf(udhcpc_cmd, sizeof(udhcpc_cmd), "dhclient -4 -d --no-pid %s", ifname);
+            dhclient_alive++;
+#else
+            if (access("/usr/share/udhcpc/default.script", X_OK)) {
+                dbg_time("Fail to access /usr/share/udhcpc/default.script, errno: %d (%s)", errno, strerror(errno));
+            }
+
+            //-f,--foreground    Run in foreground
+            //-b,--background    Background if lease is not obtained
+            //-n,--now        Exit if lease is not obtained
+            //-q,--quit        Exit after obtaining lease
+            //-t,--retries N        Send up to N discover packets (default 3)
+            snprintf(udhcpc_cmd, sizeof(udhcpc_cmd), "busybox udhcpc -f -n -q -t 5 -i %s", ifname);
+#endif
+
+#if 1 //for OpenWrt
+            if (!access("/lib/netifd/dhcp.script", X_OK) && !access("/sbin/ifup", X_OK) && !access("/sbin/ifstatus", X_OK)) {
+                dbg_time("you are use OpenWrt?");
+                dbg_time("should not calling udhcpc manually?");
+                dbg_time("should modify /etc/config/network as below?");
+                dbg_time("config interface wan");
+                dbg_time("\toption ifname	%s", ifname);
+                dbg_time("\toption proto	dhcp");
+                dbg_time("should use \"/sbin/ifstaus wan\" to check %s 's status?", ifname);
+            }
+#endif
+
+#ifdef USE_DHCLIENT            
+            pthread_create(&udhcpc_thread_id, &udhcpc_thread_attr, udhcpc_thread_function, (void*)strdup(udhcpc_cmd));
+            sleep(1);
+#else
+            pthread_create(&udhcpc_thread_id, NULL, udhcpc_thread_function, (void*)strdup(udhcpc_cmd));
+            pthread_join(udhcpc_thread_id, NULL);
+            if (ql_raw_ip_mode_check(ifname)) {
+                pthread_create(&udhcpc_thread_id, NULL, udhcpc_thread_function, (void*)strdup(udhcpc_cmd));
+                pthread_join(udhcpc_thread_id, NULL);
+            }
+#endif
+#ifdef QL_OPENWER_NETWORK_SETUP
+            ql_openwrt_setup_wan(ifname, &profile->ipv4);
+#endif
+        }
+
+        if (profile->ipv6.Address[0] && profile->ipv6.PrefixLengthIPAddr) {
+#if 1
+            //module do not support DHCPv6, only support 'Router Solicit'
+            //and it seem if enable /proc/sys/net/ipv6/conf/all/forwarding, Kernel do not send RS
+            const char *forward_file = "/proc/sys/net/ipv6/conf/all/forwarding";
+            int forward_fd = open(forward_file, O_RDONLY);
+            if (forward_fd > 0) {
+                char forward_state[2];
+                read(forward_fd, forward_state, 2);
+                if (forward_state[0] == '1') {
+                    //dbg_time("%s enabled, kernel maybe donot send 'Router Solicit'", forward_file);
+                }
+                close(forward_fd);
+            }
+
+            snprintf(shell_cmd, sizeof(shell_cmd), "ip -%d address add %s/%u dev %s",
+                6, ipv6Str(profile->ipv6.Address), profile->ipv6.PrefixLengthIPAddr, ifname);
+            ql_system(shell_cmd);
+
+            //ping6 www.qq.com
+            snprintf(shell_cmd, sizeof(shell_cmd), "ip -%d route add default via %s dev %s",
+                6, ipv6Str(profile->ipv6.Gateway), ifname);
+            ql_system(shell_cmd);
+
+            if (profile->ipv6.DnsPrimary[0] || profile->ipv6.DnsSecondary[0]) {
+                char dns1str[64], dns2str[64];
+
+                if (profile->ipv6.DnsPrimary[0]) {
+                    strcpy(dns1str, ipv6Str(profile->ipv6.DnsPrimary));
+                }
+
+                if (profile->ipv6.DnsSecondary[0]) {
+                    strcpy(dns2str, ipv6Str(profile->ipv6.DnsSecondary));
+                }
+                
+                update_resolv_conf(6, ifname, profile->ipv6.DnsPrimary[0] ? dns1str : NULL, profile->ipv6.DnsSecondary ? dns2str : NULL);
+#ifdef QL_OPENWER_NETWORK_SETUP
+                ql_openwrt_setup_wan6(ifname, &profile->ipv6);
+#endif
+            }
+#else
+#ifdef USE_DHCLIENT
+            snprintf(udhcpc_cmd, sizeof(udhcpc_cmd), "dhclient -6 -d --no-pid %s",  ifname);
+            dhclient_alive++;
+#else
+            /*
+                DHCPv6: Dibbler - a portable DHCPv6
+                1. download from http://klub.com.pl/dhcpv6/
+                2. cross-compile
+                    2.1 ./configure --host=arm-linux-gnueabihf
+                    2.2 copy dibbler-client to your board
+                3. mkdir -p /var/log/dibbler/ /var/lib/ on your board
+                4. create /etc/dibbler/client.conf on your board, the content is
+                    log-mode short
+                    log-level 7
+                    iface wwan0 {
+                        ia
+                        option dns-server
+                    }
+                 5. run "dibbler-client start" to get ipV6 address
+                 6. run "route -A inet6 add default dev wwan0" to add default route
+            */
+            snprintf(shell_cmd, sizeof(shell_cmd), "route -A inet6 add default %s", ifname);
+            ql_system(shell_cmd);
+            snprintf(udhcpc_cmd, sizeof(udhcpc_cmd), "dibbler-client run");
+            dibbler_client_alive++;
+#endif
+
+            pthread_create(&udhcpc_thread_id, &udhcpc_thread_attr, udhcpc_thread_function, (void*)strdup(udhcpc_cmd));
+#endif
+        }
+    }
+}
+
+void udhcpc_stop(PROFILE_T *profile) {
+    char *ifname = profile->usbnet_adapter;
+    char shell_cmd[128];
+
+    ql_set_driver_link_state(profile, 0);
+
+    if (profile->qmapnet_adapter) {
+        ifname = profile->qmapnet_adapter;
+    }
+
+#ifdef USE_DHCLIENT
+    if (dhclient_alive) {
+        system("killall dhclient");
+        dhclient_alive = 0;
+    }
+#endif
+    if (dibbler_client_alive) {
+        system("killall dibbler-client");
+        dibbler_client_alive = 0;
+    }
+
+//it seems when call netif_carrier_on(), and netcard 's IP is "0.0.0.0", will cause netif_queue_stopped()
+    snprintf(shell_cmd, sizeof(shell_cmd), "ifconfig %s 0.0.0.0", ifname);
+    ql_system(shell_cmd);
+    snprintf(shell_cmd, sizeof(shell_cmd), "ifconfig %s down", ifname);
+    ql_system(shell_cmd);
+
+#ifdef QL_OPENWER_NETWORK_SETUP
+    ql_openwrt_setup_wan(ifname, NULL);
+    ql_openwrt_setup_wan6(ifname, NULL);
+#endif
+}

root/package/link4all/quectel-CM/quectel1.6.0.15_src/udhcpc_netlink.c

@@ -0,0 +1,179 @@
+#include <sys/socket.h>
+#include <sys/select.h>
+#include <sys/types.h>
+#include <net/if.h>
+#include <sys/socket.h>
+#include <netinet/in.h>
+#include <arpa/inet.h>
+#include <endian.h>
+
+#include "libmnl/ifutils.h"
+#include "libmnl/dhcp/dhcp.h"
+#include "util.h"
+#include "QMIThread.h"
+
+static int ql_raw_ip_mode_check(const char *ifname)
+{
+    int fd;
+    char raw_ip[128];
+    char mode[2] = "X";
+    int mode_change = 0;
+
+    snprintf(raw_ip, sizeof(raw_ip), "/sys/class/net/%s/qmi/raw_ip", ifname);
+    if (access(raw_ip, F_OK))
+        return 0;
+
+    fd = open(raw_ip, O_RDWR | O_NONBLOCK | O_NOCTTY);
+    if (fd < 0)
+    {
+        dbg_time("%s %d fail to open(%s), errno:%d (%s)", __FILE__, __LINE__, raw_ip, errno, strerror(errno));
+        return 0;
+    }
+
+    read(fd, mode, 2);
+    if (mode[0] == '0' || mode[0] == 'N')
+    {
+        if_link_down(ifname);
+        dbg_time("echo Y > /sys/class/net/%s/qmi/raw_ip", ifname);
+        mode[0] = 'Y';
+        write(fd, mode, 2);
+        mode_change = 1;
+        if_link_up(ifname);
+    }
+
+    close(fd);
+    return mode_change;
+}
+
+static void ql_set_driver_link_state(PROFILE_T *profile, int link_state)
+{
+    char link_file[128];
+    int fd;
+    int new_state = 0;
+
+    snprintf(link_file, sizeof(link_file), "/sys/class/net/%s/link_state", profile->usbnet_adapter);
+    fd = open(link_file, O_RDWR | O_NONBLOCK | O_NOCTTY);
+    if (fd == -1)
+    {
+        if (errno != ENOENT)
+            dbg_time("Fail to access %s, errno: %d (%s)", link_file, errno, strerror(errno));
+        return;
+    }
+
+    if (profile->qmap_mode <= 1)
+        new_state = !!link_state;
+    else
+    {
+        //0x80 means link off this pdp
+        new_state = (link_state ? 0x00 : 0x80) + profile->pdp;
+    }
+
+    snprintf(link_file, sizeof(link_file), "%d\n", new_state);
+    write(fd, link_file, sizeof(link_file));
+
+    if (link_state == 0 && profile->qmap_mode > 1)
+    {
+        size_t rc;
+
+        lseek(fd, 0, SEEK_SET);
+        rc = read(fd, link_file, sizeof(link_file));
+        if (rc > 1 && (!strcasecmp(link_file, "0\n") || !strcasecmp(link_file, "0x0\n")))
+        {
+            if_link_down(profile->usbnet_adapter);
+        }
+    }
+
+    close(fd);
+}
+
+void udhcpc_start(PROFILE_T *profile)
+{
+    char *ifname = profile->usbnet_adapter;
+
+    ql_set_driver_link_state(profile, 1);
+    ql_raw_ip_mode_check(ifname);
+
+    if (profile->qmapnet_adapter)
+    {
+        ifname = profile->qmapnet_adapter;
+    }
+    if (profile->rawIP && profile->ipv4.Address && profile->ipv4.Mtu)
+    {
+        if_set_mtu(ifname, (profile->ipv4.Mtu));
+    }
+
+    if (strcmp(ifname, profile->usbnet_adapter))
+    {
+        if_link_up(profile->usbnet_adapter);
+    }
+
+    if_link_up(ifname);
+
+#if 1 //for bridge mode, only one public IP, so do udhcpc manually
+    if (ql_bridge_mode_detect(profile))
+    {
+        return;
+    }
+#endif
+    // if use DHCP(should make with ${DHCP} src files)
+    // do_dhcp(ifname);
+    // return 0;
+    /* IPv4 Addr Info */
+    if (profile->ipv4.Address)
+    {
+        dbg_time("IPv4 MTU: %d", profile->ipv4.Mtu);
+        dbg_time("IPv4 Address: %s", ipaddr_to_string_v4(ntohl(profile->ipv4.Address)));
+        dbg_time("IPv4 Netmask: %d", mask_to_prefix_v4(ntohl(profile->ipv4.SubnetMask)));
+        dbg_time("IPv4 Gateway: %s", ipaddr_to_string_v4(ntohl(profile->ipv4.Gateway)));
+        dbg_time("IPv4 DNS1: %s", ipaddr_to_string_v4(ntohl(profile->ipv4.DnsPrimary)));
+        dbg_time("IPv4 DNS2: %s", ipaddr_to_string_v4(ntohl(profile->ipv4.DnsSecondary)));
+        if_set_network_v4(ifname, ntohl(profile->ipv4.Address),
+                       mask_to_prefix_v4(profile->ipv4.SubnetMask),
+                       ntohl(profile->ipv4.Gateway),
+                       ntohl(profile->ipv4.DnsPrimary),
+                       ntohl(profile->ipv4.DnsSecondary));
+    }
+
+    if (profile->ipv6.Address[0] && profile->ipv6.PrefixLengthIPAddr)
+    {
+        //module do not support DHCPv6, only support 'Router Solicit'
+        //and it seem if enable /proc/sys/net/ipv6/conf/all/forwarding, Kernel do not send RS
+        const char *forward_file = "/proc/sys/net/ipv6/conf/all/forwarding";
+        int forward_fd = open(forward_file, O_RDONLY);
+        if (forward_fd > 0)
+        {
+            char forward_state[2];
+            read(forward_fd, forward_state, 2);
+            if (forward_state[0] == '1')
+            {
+                dbg_time("%s enabled, kernel maybe donot send 'Router Solicit'", forward_file);
+            }
+            close(forward_fd);
+        }
+
+        dbg_time("IPv6 MTU: %d", profile->ipv6.Mtu);
+        dbg_time("IPv6 Address: %s", ipaddr_to_string_v6(profile->ipv6.Address));
+        dbg_time("IPv6 Netmask: %d", profile->ipv6.PrefixLengthIPAddr);
+        dbg_time("IPv6 Gateway: %s", ipaddr_to_string_v6(profile->ipv6.Gateway));
+        dbg_time("IPv6 DNS1: %s", ipaddr_to_string_v6(profile->ipv6.DnsPrimary));
+        dbg_time("IPv6 DNS2: %s", ipaddr_to_string_v6(profile->ipv6.DnsSecondary));
+        if_set_network_v6(ifname, profile->ipv6.Address, profile->ipv6.PrefixLengthIPAddr,
+                       profile->ipv6.Gateway, profile->ipv6.DnsPrimary, profile->ipv6.DnsSecondary);
+    }
+}
+
+void udhcpc_stop(PROFILE_T *profile)
+{
+    char *ifname = profile->usbnet_adapter;
+
+    ql_set_driver_link_state(profile, 0);
+
+    if (profile->qmapnet_adapter)
+    {
+        ifname = profile->qmapnet_adapter;
+    }
+
+    if_link_down(ifname);
+    if_flush_v4_addr(ifname);
+    if_flush_v6_addr(ifname);
+}

root/package/link4all/quectel-CM/quectel1.6.0.15_src/util.c

@@ -0,0 +1,301 @@
+/******************************************************************************
+  @file    util.c
+  @brief   some utils for this QCM tool.
+
+  DESCRIPTION
+  Connectivity Management Tool for USB network adapter of Quectel wireless cellular modules.
+
+  INITIALIZATION AND SEQUENCING REQUIREMENTS
+  None.
+
+  ---------------------------------------------------------------------------
+  Copyright (c) 2016 - 2020 Quectel Wireless Solution, Co., Ltd.  All Rights Reserved.
+  Quectel Wireless Solution Proprietary and Confidential.
+  ---------------------------------------------------------------------------
+******************************************************************************/
+
+#include <sys/time.h>
+#if defined(__STDC__)
+#include <stdarg.h>
+#define __V(x)	x
+#else
+#include <varargs.h>
+#define __V(x)	(va_alist) va_dcl
+#define const
+#define volatile
+#endif
+
+#include <syslog.h>
+
+#include "QMIThread.h"
+
+static void setTimespecRelative(struct timespec *p_ts, long long msec)
+{
+    struct timeval tv;
+
+    gettimeofday(&tv, (struct timezone *) NULL);
+
+    /* what's really funny about this is that I know
+       pthread_cond_timedwait just turns around and makes this
+       a relative time again */
+    p_ts->tv_sec = tv.tv_sec + (msec / 1000);
+    p_ts->tv_nsec = (tv.tv_usec + (msec % 1000) * 1000L ) * 1000L;
+    if (p_ts->tv_nsec >= 1000000000UL) {
+        p_ts->tv_sec += 1;
+        p_ts->tv_nsec -= 1000000000UL;
+    }
+}
+
+int pthread_cond_timeout_np(pthread_cond_t *cond, pthread_mutex_t * mutex, unsigned msecs) {
+    if (msecs != 0) {
+        unsigned i;
+        unsigned t = msecs/4;
+        int ret = 0;
+
+        if (t == 0)
+            t = 1;
+
+        for (i = 0; i < msecs; i += t) {
+            struct timespec ts;
+            setTimespecRelative(&ts, t);
+            ret = pthread_cond_timedwait(cond, mutex, &ts); //to advoid system time change
+            if (ret != ETIMEDOUT) {
+                if(ret) dbg_time("ret=%d, msecs=%u, t=%u", ret, msecs, t);
+                break;
+            }
+        }
+
+        return ret;
+    } else {
+        return pthread_cond_wait(cond, mutex);
+    }
+}
+
+void cond_setclock_attr(pthread_cond_t *cond, clockid_t clock)
+{
+#if 0 //very old uclibc do not support pthread_condattr_setclock
+    /* set relative time, for pthread_cond_timedwait */
+    pthread_condattr_t attr;
+    pthread_condattr_init (&attr);
+    pthread_condattr_setclock(&attr, clock);
+    pthread_cond_init(cond, &attr);
+    pthread_condattr_destroy (&attr);
+#endif
+}
+
+const char * get_time(void) {
+    static char time_buf[50];
+    struct timeval  tv;
+    time_t time;
+    suseconds_t millitm;
+    struct tm *ti;
+
+    gettimeofday (&tv, NULL);
+
+    time= tv.tv_sec;
+    millitm = (tv.tv_usec + 500) / 1000;
+
+    if (millitm == 1000) {
+        ++time;
+        millitm = 0;
+    }
+
+    ti = localtime(&time);
+    sprintf(time_buf, "%02d-%02d_%02d:%02d:%02d:%03d", ti->tm_mon+1, ti->tm_mday, ti->tm_hour, ti->tm_min, ti->tm_sec, (int)millitm);
+    return time_buf;
+}
+
+unsigned long clock_msec(void)
+{
+	struct timespec tm;
+	clock_gettime( CLOCK_MONOTONIC, &tm);
+	return (unsigned long)(tm.tv_sec*1000 + (tm.tv_nsec/1000000));
+}
+
+FILE *logfilefp = NULL;
+
+const int i = 1;
+#define is_bigendian() ( (*(char*)&i) == 0 )
+
+USHORT le16_to_cpu(USHORT v16) {
+    USHORT tmp = v16;
+    if (is_bigendian()) {
+        unsigned char *s = (unsigned char *)(&v16);
+        unsigned char *d = (unsigned char *)(&tmp);
+        d[0] = s[1];
+        d[1] = s[0];
+    }
+    return tmp;
+}
+
+UINT  le32_to_cpu (UINT v32) {
+    UINT tmp = v32;
+    if (is_bigendian()) {
+        unsigned char *s = (unsigned char *)(&v32);
+        unsigned char *d = (unsigned char *)(&tmp);
+        d[0] = s[3];
+        d[1] = s[2];
+        d[2] = s[1];
+        d[3] = s[0];
+    }
+    return tmp;
+}
+
+UINT ql_swap32(UINT v32) {
+    UINT tmp = v32;
+    {
+        unsigned char *s = (unsigned char *)(&v32);
+        unsigned char *d = (unsigned char *)(&tmp);
+        d[0] = s[3];
+        d[1] = s[2];
+        d[2] = s[1];
+        d[3] = s[0];
+    }
+    return tmp;
+}
+
+USHORT cpu_to_le16(USHORT v16) {
+    USHORT tmp = v16;
+    if (is_bigendian()) {
+        unsigned char *s = (unsigned char *)(&v16);
+        unsigned char *d = (unsigned char *)(&tmp);
+        d[0] = s[1];
+        d[1] = s[0];
+    }
+    return tmp;
+}
+
+UINT cpu_to_le32 (UINT v32) {
+    UINT tmp = v32;
+    if (is_bigendian()) {
+        unsigned char *s = (unsigned char *)(&v32);
+        unsigned char *d = (unsigned char *)(&tmp);
+        d[0] = s[3];
+        d[1] = s[2];
+        d[2] = s[1];
+        d[3] = s[0];
+    }
+    return tmp;
+}
+
+void update_resolv_conf(int iptype, const char *ifname, const char *dns1, const char *dns2) {
+    const char *dns_file = "/etc/resolv.conf";
+    FILE *dns_fp;
+    char dns_line[256];
+    #define MAX_DNS 16
+    char *dns_info[MAX_DNS];
+    char dns_tag[64];
+    int dns_match = 0;
+    int i;
+
+    snprintf(dns_tag, sizeof(dns_tag), "# IPV%d %s", iptype, ifname);
+
+    for (i = 0; i < MAX_DNS; i++)
+        dns_info[i] = NULL;
+    
+    dns_fp = fopen(dns_file, "r");
+    if (dns_fp) {
+        i = 0;    
+        dns_line[sizeof(dns_line)-1] = '\0';
+        
+        while((fgets(dns_line, sizeof(dns_line)-1, dns_fp)) != NULL) {
+            if ((strlen(dns_line) > 1) && (dns_line[strlen(dns_line) - 1] == '\n'))
+                dns_line[strlen(dns_line) - 1] = '\0';
+            //dbg_time("%s", dns_line);
+            if (strstr(dns_line, dns_tag)) {
+                dns_match++;
+                continue;
+            }
+            dns_info[i++] = strdup(dns_line);
+            if (i == MAX_DNS)
+                break;
+        }
+
+        fclose(dns_fp);
+    }
+    else if (errno != ENOENT) {
+        dbg_time("fopen %s fail, errno:%d (%s)", dns_file, errno, strerror(errno));
+        return;
+    }
+    
+    if (dns1 == NULL && dns_match == 0)
+        return;
+
+    dns_fp = fopen(dns_file, "w");
+    if (dns_fp) {
+        if (dns1)
+            fprintf(dns_fp, "nameserver %s %s\n", dns1, dns_tag);
+        if (dns2)
+            fprintf(dns_fp, "nameserver %s %s\n", dns2, dns_tag);
+        
+        for (i = 0; i < MAX_DNS && dns_info[i]; i++)
+            fprintf(dns_fp, "%s\n", dns_info[i]);
+        fclose(dns_fp);
+    }
+    else {
+        dbg_time("fopen %s fail, errno:%d (%s)", dns_file, errno, strerror(errno));
+    }
+
+    for (i = 0; i < MAX_DNS && dns_info[i]; i++)
+        free(dns_info[i]);
+}
+
+pid_t getpid_by_pdp(int pdp, const char* program_name)
+{
+    glob_t gt;
+    int ret;
+    char filter[5] = {0};
+    pid_t pid;
+
+    sprintf(filter, "-n %d", pdp);
+    ret = glob("/proc/*/cmdline", GLOB_NOSORT, NULL, &gt);
+    if (ret != 0) {
+        dbg_time("glob error, errno = %d(%s)", errno, strerror(errno));
+		return -1;
+    } else {
+        int i = 0, fd = -1;
+        size_t nreads;
+        char cmdline[512] = {0};
+
+		for (i = 0; i < gt.gl_pathc; i++) {
+            fd = open(gt.gl_pathv[i], O_RDONLY);
+            if (fd == -1) {
+                dbg_time("open %s failed, errno = %d(%s)", gt.gl_pathv[i], errno, strerror(errno));
+                globfree(&gt);
+                return -1;
+            }
+            
+            nreads = read(fd, cmdline, sizeof(cmdline));
+            if (nreads > 0) {
+                int pos = 0;
+                while (pos < nreads-1) {
+                    if (cmdline[pos] == '\0')
+                        cmdline[pos] = ' ';  // space
+                    pos++;
+                }
+                // printf("%s\n", cmdline);
+            }
+
+            if (strstr(cmdline, program_name) && strstr(cmdline, filter)) {
+            	char path[64] = {0};
+            	char pidstr[64] = {0};
+            	char *p;
+            	
+                dbg_time("%s: %s", gt.gl_pathv[i], cmdline);
+            	strcpy(path, gt.gl_pathv[i]);
+            	p = strstr(gt.gl_pathv[i], "/cmdline");
+            	*p = '\0';
+            	while (*(--p) != '/') ;
+            		
+            	strcpy(pidstr, p+1);
+            	pid = atoi(pidstr);
+            	globfree(&gt);
+                
+                return pid;
+            }
+        }
+    }
+
+    globfree(&gt);
+    return -1;
+}

root/package/link4all/quectel-CM/quectel1.6.0.15_src/util.h

@@ -0,0 +1,52 @@
+/**  
+  @file
+  util.h
+
+  @brief
+  This file provides the definitions, and declares some common APIs for list-algorithm.
+
+ */
+
+#ifndef _UTILS_H_
+#define _UTILS_H_
+
+#include <stddef.h>
+#include <glob.h>
+
+struct listnode
+{
+    struct listnode *next;
+    struct listnode *prev;
+};
+
+#define node_to_item(node, container, member) \
+    (container *) (((char*) (node)) - offsetof(container, member))
+
+#define list_declare(name) \
+    struct listnode name = { \
+        .next = &name, \
+        .prev = &name, \
+    }
+
+#define list_for_each(node, list) \
+    for (node = (list)->next; node != (list); node = node->next)
+
+#define list_for_each_reverse(node, list) \
+    for (node = (list)->prev; node != (list); node = node->prev)
+
+void list_init(struct listnode *list);
+void list_add_tail(struct listnode *list, struct listnode *item);
+void list_add_head(struct listnode *head, struct listnode *item);
+void list_remove(struct listnode *item);
+
+#define list_empty(list) ((list) == (list)->next)
+#define list_head(list) ((list)->next)
+#define list_tail(list) ((list)->prev)
+
+int epoll_register(int  epoll_fd, int  fd, unsigned int events);
+int epoll_deregister(int  epoll_fd, int  fd);
+const char * get_time(void);
+unsigned long clock_msec(void);
+pid_t getpid_by_pdp(int, const char*);
+
+#endif

root/package/link4all/quectel-CM/simcom-cm/GobiNetCM.c

@@ -0,0 +1,217 @@
+#include <stdio.h>
+#include <string.h>
+#include <termios.h>
+#include <stdio.h>
+#include <ctype.h>
+#include "QMIThread.h"
+
+#ifdef CONFIG_GOBINET
+
+// IOCTL to generate a client ID for this service type
+#define IOCTL_QMI_GET_SERVICE_FILE 0x8BE0 + 1
+
+// IOCTL to get the VIDPID of the device
+#define IOCTL_QMI_GET_DEVICE_VIDPID 0x8BE0 + 2
+
+// IOCTL to get the MEID of the device
+#define IOCTL_QMI_GET_DEVICE_MEID 0x8BE0 + 3
+
+int GobiNetSendQMI(PQCQMIMSG pRequest) {
+    int ret, fd;
+
+    fd = qmiclientId[pRequest->QMIHdr.QMIType];
+
+    if (fd <= 0) {
+        dbg_time("%s QMIType: %d has no clientID", __func__, pRequest->QMIHdr.QMIType);
+        return -ENODEV;
+    }
+
+    // Always ready to write
+    if (1 == 1) {
+        ssize_t nwrites = le16_to_cpu(pRequest->QMIHdr.Length) + 1 - sizeof(QCQMI_HDR);
+        ret = write(fd, &pRequest->MUXMsg, nwrites);
+        if (ret == nwrites) {
+            ret = 0;
+        } else {
+            dbg_time("%s write=%d, errno: %d (%s)", __func__, ret, errno, strerror(errno));
+        }
+    } else {
+        dbg_time("%s poll=%d, errno: %d (%s)", __func__, ret, errno, strerror(errno));
+    }
+
+    return ret;
+}
+
+static int GobiNetGetClientID(const char *qcqmi, UCHAR QMIType) {
+    int ClientId;
+    ClientId = open(qcqmi, O_RDWR | O_NONBLOCK | O_NOCTTY);
+    if (ClientId == -1) {
+        dbg_time("failed to open %s, errno: %d (%s)", qcqmi, errno, strerror(errno));
+        return -1;
+    }
+    fcntl(cdc_wdm_fd, F_SETFD, FD_CLOEXEC) ;
+
+    if (ioctl(ClientId, IOCTL_QMI_GET_SERVICE_FILE, QMIType) != 0) {
+        dbg_time("failed to get ClientID for 0x%02x errno: %d (%s)", QMIType, errno, strerror(errno));
+        close(ClientId);
+        ClientId = 0;
+    }
+
+    switch (QMIType) {
+        case QMUX_TYPE_WDS: dbg_time("Get clientWDS = %d", ClientId); break;
+        case QMUX_TYPE_DMS: dbg_time("Get clientDMS = %d", ClientId); break;
+        case QMUX_TYPE_NAS: dbg_time("Get clientNAS = %d", ClientId); break;
+        case QMUX_TYPE_QOS: dbg_time("Get clientQOS = %d", ClientId); break;
+        case QMUX_TYPE_WMS: dbg_time("Get clientWMS = %d", ClientId); break;
+        case QMUX_TYPE_PDS: dbg_time("Get clientPDS = %d", ClientId); break;
+        case QMUX_TYPE_UIM: dbg_time("Get clientUIM = %d", ClientId); break;
+        case QMUX_TYPE_WDS_ADMIN: dbg_time("Get clientWDA = %d", ClientId);
+        break;
+        default: break;
+    }
+
+    return ClientId;
+}
+
+int GobiNetDeInit(void) {
+    unsigned int i;
+    for (i = 0; i < sizeof(qmiclientId)/sizeof(qmiclientId[0]); i++)
+    {
+        if (qmiclientId[i] != 0)
+        {
+            close(qmiclientId[i]);
+            qmiclientId[i] = 0;
+        }
+    }
+
+    return 0;
+}
+
+void * GobiNetThread(void *pData) {
+    PROFILE_T *profile = (PROFILE_T *)pData;
+    const char *qcqmi = (const char *)profile->qmichannel;
+    
+    qmiclientId[QMUX_TYPE_WDS] = GobiNetGetClientID(qcqmi, QMUX_TYPE_WDS);
+    if (profile->IsDualIPSupported)
+        qmiclientId[QMUX_TYPE_WDS_IPV6] = GobiNetGetClientID(qcqmi, QMUX_TYPE_WDS);
+    qmiclientId[QMUX_TYPE_DMS] = GobiNetGetClientID(qcqmi, QMUX_TYPE_DMS);
+    qmiclientId[QMUX_TYPE_NAS] = GobiNetGetClientID(qcqmi, QMUX_TYPE_NAS);
+    qmiclientId[QMUX_TYPE_UIM] = GobiNetGetClientID(qcqmi, QMUX_TYPE_UIM);
+    qmiclientId[QMUX_TYPE_WDS_ADMIN] = GobiNetGetClientID(qcqmi, QMUX_TYPE_WDS_ADMIN);
+
+    //donot check clientWDA, there is only one client for WDA, if quectel-CM is killed by SIGKILL, i cannot get client ID for WDA again!
+    if (qmiclientId[QMUX_TYPE_WDS] == 0)  /*|| (clientWDA == -1)*/ {
+        GobiNetDeInit();
+        dbg_time("%s Failed to open %s, errno: %d (%s)", __func__, qcqmi, errno, strerror(errno));
+        qmidevice_send_event_to_main(RIL_INDICATE_DEVICE_DISCONNECTED);
+        pthread_exit(NULL);
+        return NULL;
+    }
+
+    qmidevice_send_event_to_main(RIL_INDICATE_DEVICE_CONNECTED);
+
+    while (1) {
+        struct pollfd pollfds[16] = {{qmidevice_control_fd[1], POLLIN, 0}};
+        int ne, ret, nevents = 1;
+        unsigned int i;
+
+        for (i = 0; i < sizeof(qmiclientId)/sizeof(qmiclientId[0]); i++)
+        {
+            if (qmiclientId[i] != 0)
+            {
+                pollfds[nevents].fd = qmiclientId[i];
+                pollfds[nevents].events = POLLIN;
+                pollfds[nevents].revents = 0;
+                nevents++;
+            }
+        }
+
+        do {
+            ret = poll(pollfds, nevents, -1);
+         } while ((ret < 0) && (errno == EINTR));
+
+        if (ret <= 0) {
+            dbg_time("%s poll=%d, errno: %d (%s)", __func__, ret, errno, strerror(errno));
+            break;
+        }
+
+        for (ne = 0; ne < nevents; ne++) {
+            int fd = pollfds[ne].fd;
+            short revents = pollfds[ne].revents;
+
+            if (revents & (POLLERR | POLLHUP | POLLNVAL)) {
+                dbg_time("%s poll err/hup/inval", __func__);
+                dbg_time("epoll fd = %d, events = 0x%04x", fd, revents);
+                if (fd == qmidevice_control_fd[1]) {
+                } else {
+                }
+                if (revents & (POLLERR | POLLHUP | POLLNVAL))
+                    goto __GobiNetThread_quit;
+            }
+
+            if ((revents & POLLIN) == 0)
+                continue;
+
+            if (fd == qmidevice_control_fd[1]) {
+                int triger_event;
+                if (read(fd, &triger_event, sizeof(triger_event)) == sizeof(triger_event)) {
+                    //DBG("triger_event = 0x%x", triger_event);
+                    switch (triger_event) {
+                        case RIL_REQUEST_QUIT:
+                            goto __GobiNetThread_quit;
+                        break;
+                        case SIGTERM:
+                        case SIGHUP:
+                        case SIGINT:
+                            QmiThreadRecvQMI(NULL);
+                        break;
+                        default:
+                        break;
+                    }
+                }
+                continue;
+            }
+
+            {
+                ssize_t nreads;
+                UCHAR QMIBuf[512];
+                PQCQMIMSG pResponse = (PQCQMIMSG)QMIBuf;
+
+                nreads = read(fd, &pResponse->MUXMsg, sizeof(QMIBuf) - sizeof(QCQMI_HDR));
+                if (nreads <= 0)
+                {
+                    dbg_time("%s read=%d errno: %d (%s)",  __func__, (int)nreads, errno, strerror(errno));
+                    break;
+                }
+
+                for (i = 0; i < sizeof(qmiclientId)/sizeof(qmiclientId[0]); i++)
+                {
+                    if (qmiclientId[i] == fd)
+                    {
+                        pResponse->QMIHdr.QMIType = i;
+                    }
+                }
+
+                pResponse->QMIHdr.IFType = USB_CTL_MSG_TYPE_QMI;
+                pResponse->QMIHdr.Length = cpu_to_le16(nreads + sizeof(QCQMI_HDR)  - 1);
+                pResponse->QMIHdr.CtlFlags = 0x00;
+                pResponse->QMIHdr.ClientId = fd & 0xFF;
+
+                QmiThreadRecvQMI(pResponse);
+            }
+        }
+    }
+
+__GobiNetThread_quit:
+    GobiNetDeInit();
+    qmidevice_send_event_to_main(RIL_INDICATE_DEVICE_DISCONNECTED);
+    QmiThreadRecvQMI(NULL); //main thread may pending on QmiThreadSendQMI()
+    dbg_time("%s exit", __func__);
+    pthread_exit(NULL);
+    return NULL;
+}
+
+#else
+int GobiNetSendQMI(PQCQMIMSG pRequest) {return -1;}
+void * GobiNetThread(void *pData) {dbg_time("please set CONFIG_GOBINET"); return NULL;}
+#endif

root/package/link4all/quectel-CM/simcom-cm/MPQCTL.h

@@ -0,0 +1,376 @@
+/*===========================================================================
+
+                            M P Q C T L. H
+DESCRIPTION:
+
+    This module contains QMI QCTL module.
+
+INITIALIZATION AND SEQUENCING REQUIREMENTS:
+
+Copyright (C) 2011 by Qualcomm Technologies, Incorporated.  All Rights Reserved.
+===========================================================================*/
+
+#ifndef MPQCTL_H
+#define MPQCTL_H
+
+#include "MPQMI.h"
+
+#pragma pack(push, 1)
+
+// ================= QMICTL ==================
+
+// QMICTL Control Flags
+#define QMICTL_CTL_FLAG_CMD     0x00
+#define QMICTL_CTL_FLAG_RSP     0x01
+#define QMICTL_CTL_FLAG_IND     0x02
+
+#if 0
+typedef struct _QMICTL_TRANSACTION_ITEM
+{
+   LIST_ENTRY  List;
+   UCHAR       TransactionId;  // QMICTL transaction id
+   PVOID       Context;        // Adapter or IocDev
+   PIRP        Irp;
+} QMICTL_TRANSACTION_ITEM, *PQMICTL_TRANSACTION_ITEM;
+#endif
+
+typedef struct _QCQMICTL_MSG_HDR
+{
+   UCHAR  CtlFlags;  // 00-cmd, 01-rsp, 10-ind
+   UCHAR  TransactionId;
+   USHORT QMICTLType;
+   USHORT Length;
+} __attribute__ ((packed)) QCQMICTL_MSG_HDR, *PQCQMICTL_MSG_HDR;
+
+#define QCQMICTL_MSG_HDR_SIZE sizeof(QCQMICTL_MSG_HDR)
+
+typedef struct _QCQMICTL_MSG_HDR_RESP
+{
+   UCHAR  CtlFlags;  // 00-cmd, 01-rsp, 10-ind
+   UCHAR  TransactionId;
+   USHORT QMICTLType;
+   USHORT Length;
+   UCHAR  TLVType;          // 0x02 - result code
+   USHORT TLVLength;        // 4
+   USHORT QMUXResult;       // QMI_RESULT_SUCCESS
+                            // QMI_RESULT_FAILURE
+   USHORT QMUXError;        // QMI_ERR_INVALID_ARG
+                            // QMI_ERR_NO_MEMORY
+                            // QMI_ERR_INTERNAL
+                            // QMI_ERR_FAULT
+} __attribute__ ((packed)) QCQMICTL_MSG_HDR_RESP, *PQCQMICTL_MSG_HDR_RESP;
+
+typedef struct _QCQMICTL_MSG
+{
+   UCHAR  CtlFlags;  // 00-cmd, 01-rsp, 10-ind
+   UCHAR  TransactionId;
+   USHORT QMICTLType;
+   USHORT Length;
+   UCHAR  Payload;
+} __attribute__ ((packed)) QCQMICTL_MSG, *PQCQMICTL_MSG;
+
+// TLV Header
+typedef struct _QCQMICTL_TLV_HDR
+{
+   UCHAR  TLVType;
+   USHORT TLVLength;
+} __attribute__ ((packed)) QCQMICTL_TLV_HDR, *PQCQMICTL_TLV_HDR;
+
+#define QCQMICTL_TLV_HDR_SIZE sizeof(QCQMICTL_TLV_HDR)
+
+// QMICTL Type
+#define QMICTL_SET_INSTANCE_ID_REQ    0x0020
+#define QMICTL_SET_INSTANCE_ID_RESP   0x0020
+#define QMICTL_GET_VERSION_REQ        0x0021
+#define QMICTL_GET_VERSION_RESP       0x0021
+#define QMICTL_GET_CLIENT_ID_REQ      0x0022
+#define QMICTL_GET_CLIENT_ID_RESP     0x0022
+#define QMICTL_RELEASE_CLIENT_ID_REQ  0x0023
+#define QMICTL_RELEASE_CLIENT_ID_RESP 0x0023
+#define QMICTL_REVOKE_CLIENT_ID_IND   0x0024
+#define QMICTL_INVALID_CLIENT_ID_IND  0x0025
+#define QMICTL_SET_DATA_FORMAT_REQ    0x0026
+#define QMICTL_SET_DATA_FORMAT_RESP   0x0026
+#define QMICTL_SYNC_REQ               0x0027
+#define QMICTL_SYNC_RESP              0x0027
+#define QMICTL_SYNC_IND               0x0027
+
+#define QMICTL_FLAG_REQUEST    0x00
+#define QMICTL_FLAG_RESPONSE   0x01
+#define QMICTL_FLAG_INDICATION 0x02
+
+// QMICTL Message Definitions
+
+typedef struct _QMICTL_SET_INSTANCE_ID_REQ_MSG
+{
+   UCHAR  CtlFlags;        // QMICTL_FLAG_REQUEST
+   UCHAR  TransactionId;
+   USHORT QMICTLType;      // QMICTL_SET_INSTANCE_ID_REQ
+   USHORT Length;          // 4
+   UCHAR  TLVType;         // QCTLV_TYPE_REQUIRED_PARAMETER
+   USHORT TLVLength;       // 1
+   UCHAR  Value;           // Host-unique QMI instance for this device driver
+} __attribute__ ((packed)) QMICTL_SET_INSTANCE_ID_REQ_MSG, *PQMICTL_SET_INSTANCE_ID_REQ_MSG;
+
+typedef struct _QMICTL_SET_INSTANCE_ID_RESP_MSG
+{
+   UCHAR  CtlFlags;        // QMICTL_FLAG_RESPONSE
+   UCHAR  TransactionId;
+   USHORT QMICTLType;      // QMICTL_SET_INSTANCE_ID_RESP
+   USHORT Length;
+   UCHAR  TLVType;         // QCTLV_TYPE_RESULT_CODE
+   USHORT TLVLength;       // 0x0004
+   USHORT QMIResult;
+   USHORT QMIError;
+   UCHAR  TLV2Type;        // QCTLV_TYPE_REQUIRED_PARAMETER
+   USHORT TLV2Length;      // 0x0002
+   USHORT QMI_ID;          // Upper byte is assigned by MSM,
+                           // lower assigned by host
+} __attribute__ ((packed)) QMICTL_SET_INSTANCE_ID_RESP_MSG, *PQMICTL_SET_INSTANCE_ID_RESP_MSG;
+
+typedef struct _QMICTL_GET_VERSION_REQ_MSG
+{
+   UCHAR  CtlFlags;        // QMICTL_FLAG_REQUEST
+   UCHAR  TransactionId;
+   USHORT QMICTLType;      // QMICTL_GET_VERSION_REQ
+   USHORT Length;          // 0
+   UCHAR  TLVType;         // QCTLV_TYPE_REQUIRED_PARAMETER
+   USHORT TLVLength;       // var
+   UCHAR  QMUXTypes;       // List of one byte QMUX_TYPE values
+                           // 0xFF returns a list of versions for all
+                           // QMUX_TYPEs implemented on the device
+} __attribute__ ((packed)) QMICTL_GET_VERSION_REQ_MSG, *PQMICTL_GET_VERSION_REQ_MSG;
+
+typedef struct _QMUX_TYPE_VERSION_STRUCT
+{
+   UCHAR  QMUXType;
+   USHORT MajorVersion;
+   USHORT MinorVersion;
+} __attribute__ ((packed)) QMUX_TYPE_VERSION_STRUCT, *PQMUX_TYPE_VERSION_STRUCT;
+
+typedef struct _ADDENDUM_VERSION_PREAMBLE
+{
+   UCHAR LabelLength;
+   UCHAR Label;
+} __attribute__ ((packed)) ADDENDUM_VERSION_PREAMBLE, *PADDENDUM_VERSION_PREAMBLE;
+
+#define QMICTL_GET_VERSION_RSP_TLV_TYPE_VERSION     0x01
+#define QMICTL_GET_VERSION_RSP_TLV_TYPE_ADD_VERSION 0x10
+
+typedef struct _QMICTL_GET_VERSION_RESP_MSG
+{
+   UCHAR  CtlFlags;        // QMICTL_FLAG_RESPONSE
+   UCHAR  TransactionId;
+   USHORT QMICTLType;      // QMICTL_GET_VERSION_RESP
+   USHORT Length;
+   UCHAR  TLVType;         // QCTLV_TYPE_RESULT_CODE
+   USHORT TLVLength;       // 0x0004
+   USHORT QMIResult;
+   USHORT QMIError;
+   UCHAR  TLV2Type;        // QCTLV_TYPE_REQUIRED_PARAMETER
+   USHORT TLV2Length;      // var
+   UCHAR  NumElements;     // Num of QMUX_TYPE_VERSION_STRUCT
+   QMUX_TYPE_VERSION_STRUCT TypeVersion;
+} __attribute__ ((packed)) QMICTL_GET_VERSION_RESP_MSG, *PQMICTL_GET_VERSION_RESP_MSG;
+
+typedef struct _QMICTL_GET_CLIENT_ID_REQ_MSG
+{
+   UCHAR  CtlFlags;        // QMICTL_FLAG_REQUEST
+   UCHAR  TransactionId;
+   USHORT QMICTLType;      // QMICTL_GET_CLIENT_ID_REQ
+   USHORT Length;
+   UCHAR  TLVType;         // QCTLV_TYPE_REQUIRED_PARAMETER
+   USHORT TLVLength;       // 1
+   UCHAR  QMIType;         // QMUX type
+} __attribute__ ((packed)) QMICTL_GET_CLIENT_ID_REQ_MSG, *PQMICTL_GET_CLIENT_ID_REQ_MSG;
+
+typedef struct _QMICTL_GET_CLIENT_ID_RESP_MSG
+{
+   UCHAR  CtlFlags;        // QMICTL_FLAG_RESPONSE
+   UCHAR  TransactionId;
+   USHORT QMICTLType;      // QMICTL_GET_CLIENT_ID_RESP
+   USHORT Length;
+   UCHAR  TLVType;         // QCTLV_TYPE_RESULT_CODE
+   USHORT TLVLength;       // 0x0004
+   USHORT QMIResult;       // result code
+   USHORT QMIError;        // error code
+   UCHAR  TLV2Type;        // QCTLV_TYPE_REQUIRED_PARAMETER
+   USHORT TLV2Length;      // 2
+   UCHAR  QMIType;
+   UCHAR  ClientId;
+} __attribute__ ((packed)) QMICTL_GET_CLIENT_ID_RESP_MSG, *PQMICTL_GET_CLIENT_ID_RESP_MSG;
+
+typedef struct _QMICTL_RELEASE_CLIENT_ID_REQ_MSG
+{
+   UCHAR  CtlFlags;        // QMICTL_FLAG_REQUEST
+   UCHAR  TransactionId;
+   USHORT QMICTLType;      // QMICTL_RELEASE_CLIENT_ID_REQ
+   USHORT Length;
+   UCHAR  TLVType;         // QCTLV_TYPE_REQUIRED_PARAMETER
+   USHORT TLVLength;       // 0x0002
+   UCHAR  QMIType;
+   UCHAR  ClientId;
+} __attribute__ ((packed)) QMICTL_RELEASE_CLIENT_ID_REQ_MSG, *PQMICTL_RELEASE_CLIENT_ID_REQ_MSG;
+
+typedef struct _QMICTL_RELEASE_CLIENT_ID_RESP_MSG
+{
+   UCHAR  CtlFlags;        // QMICTL_FLAG_RESPONSE
+   UCHAR  TransactionId;
+   USHORT QMICTLType;      // QMICTL_RELEASE_CLIENT_ID_RESP
+   USHORT Length;
+   UCHAR  TLVType;         // QCTLV_TYPE_RESULT_CODE
+   USHORT TLVLength;       // 0x0004
+   USHORT QMIResult;       // result code
+   USHORT QMIError;        // error code
+   UCHAR  TLV2Type;        // QCTLV_TYPE_REQUIRED_PARAMETER
+   USHORT TLV2Length;      // 2
+   UCHAR  QMIType;
+   UCHAR  ClientId;
+} __attribute__ ((packed)) QMICTL_RELEASE_CLIENT_ID_RESP_MSG, *PQMICTL_RELEASE_CLIENT_ID_RESP_MSG;
+
+typedef struct _QMICTL_REVOKE_CLIENT_ID_IND_MSG
+{
+   UCHAR  CtlFlags;        // QMICTL_FLAG_INDICATION
+   UCHAR  TransactionId;
+   USHORT QMICTLType;      // QMICTL_REVOKE_CLIENT_ID_IND
+   USHORT Length;
+   UCHAR  TLVType;         // QCTLV_TYPE_REQUIRED_PARAMETER
+   USHORT TLVLength;       // 0x0002
+   UCHAR  QMIType;
+   UCHAR  ClientId;
+} __attribute__ ((packed)) QMICTL_REVOKE_CLIENT_ID_IND_MSG, *PQMICTL_REVOKE_CLIENT_ID_IND_MSG;
+
+typedef struct _QMICTL_INVALID_CLIENT_ID_IND_MSG
+{
+   UCHAR  CtlFlags;        // QMICTL_FLAG_INDICATION
+   UCHAR  TransactionId;
+   USHORT QMICTLType;      // QMICTL_REVOKE_CLIENT_ID_IND
+   USHORT Length;
+   UCHAR  TLVType;         // QCTLV_TYPE_REQUIRED_PARAMETER
+   USHORT TLVLength;       // 0x0002
+   UCHAR  QMIType;
+   UCHAR  ClientId;
+} __attribute__ ((packed)) QMICTL_INVALID_CLIENT_ID_IND_MSG, *PQMICTL_INVALID_CLIENT_ID_IND_MSG;
+
+typedef struct _QMICTL_SET_DATA_FORMAT_REQ_MSG
+{
+   UCHAR  CtlFlags;        // QMICTL_FLAG_REQUEST
+   UCHAR  TransactionId;
+   USHORT QMICTLType;      // QMICTL_SET_DATA_FORMAT_REQ
+   USHORT Length;
+   UCHAR  TLVType;         // QCTLV_TYPE_REQUIRED_PARAMETER
+   USHORT TLVLength;       // 1
+   UCHAR  DataFormat;      // 0-default; 1-QoS hdr present
+} __attribute__ ((packed)) QMICTL_SET_DATA_FORMAT_REQ_MSG, *PQMICTL_SET_DATA_FORMAT_REQ_MSG;
+
+#ifdef QC_IP_MODE
+#define SET_DATA_FORMAT_TLV_TYPE_LINK_PROTO 0x10
+#define SET_DATA_FORMAT_LINK_PROTO_ETH      0x0001
+#define SET_DATA_FORMAT_LINK_PROTO_IP       0x0002
+typedef struct _QMICTL_SET_DATA_FORMAT_TLV_LINK_PROT
+{
+   UCHAR  TLVType;         // Link-Layer Protocol
+   USHORT TLVLength;       // 2
+   USHORT LinkProt;        // 0x1: ETH; 0x2: IP
+} QMICTL_SET_DATA_FORMAT_TLV_LINK_PROT, *PQMICTL_SET_DATA_FORMAT_TLV_LINK_PROT;
+
+#ifdef QCMP_UL_TLP
+#define SET_DATA_FORMAT_TLV_TYPE_UL_TLP 0x11
+typedef struct _QMICTL_SET_DATA_FORMAT_TLV_UL_TLP
+{
+   UCHAR  TLVType;         // 0x11, Uplink TLP Setting
+   USHORT TLVLength;       // 1
+   UCHAR  UlTlpSetting;    // 0x0: Disable; 0x01: Enable
+} QMICTL_SET_DATA_FORMAT_TLV_UL_TLP, *PQMICTL_SET_DATA_FORMAT_TLV_UL_TLP;
+#endif // QCMP_UL_TLP
+
+#ifdef QCMP_DL_TLP
+#define SET_DATA_FORMAT_TLV_TYPE_DL_TLP 0x13
+typedef struct _QMICTL_SET_DATA_FORMAT_TLV_DL_TLP
+{
+   UCHAR  TLVType;         // 0x11, Uplink TLP Setting
+   USHORT TLVLength;       // 1
+   UCHAR  DlTlpSetting;    // 0x0: Disable; 0x01: Enable
+} QMICTL_SET_DATA_FORMAT_TLV_DL_TLP, *PQMICTL_SET_DATA_FORMAT_TLV_DL_TLP;
+#endif // QCMP_DL_TLP
+
+#endif // QC_IP_MODE
+
+#ifdef MP_QCQOS_ENABLED
+#define SET_DATA_FORMAT_TLV_TYPE_QOS_SETTING 0x12
+typedef struct _QMICTL_SET_DATA_FORMAT_TLV_QOS_SETTING
+{
+   UCHAR  TLVType;       // 0x12, QoS setting
+   USHORT TLVLength;     // 1
+   UCHAR  QosSetting;    // 0x0: Disable; 0x01: Enable
+} QMICTL_SET_DATA_FORMAT_TLV_QOS_SETTING, *PQMICTL_SET_DATA_FORMAT_TLV_QOS_SETTING;
+#endif // MP_QCQOS_ENABLED
+
+typedef struct _QMICTL_SET_DATA_FORMAT_RESP_MSG
+{
+   UCHAR  CtlFlags;        // QMICTL_FLAG_RESPONSE
+   UCHAR  TransactionId;
+   USHORT QMICTLType;      // QMICTL_SET_DATA_FORMAT_RESP
+   USHORT Length;
+   UCHAR  TLVType;         // QCTLV_TYPE_RESULT_CODE
+   USHORT TLVLength;       // 0x0004
+   USHORT QMIResult;       // result code
+   USHORT QMIError;        // error code
+} __attribute__ ((packed)) QMICTL_SET_DATA_FORMAT_RESP_MSG, *PQMICTL_SET_DATA_FORMAT_RESP_MSG;
+
+typedef struct _QMICTL_SYNC_REQ_MSG
+{
+   UCHAR  CtlFlags;        // QMICTL_FLAG_REQUEST
+   UCHAR  TransactionId;
+   USHORT QMICTLType;      // QMICTL_CTL_SYNC_REQ
+   USHORT Length;          // 0
+} __attribute__ ((packed)) QMICTL_SYNC_REQ_MSG, *PQMICTL_SYNC_REQ_MSG;
+
+typedef struct _QMICTL_SYNC_RESP_MSG
+{
+   UCHAR  CtlFlags;        // QMICTL_FLAG_RESPONSE
+   UCHAR  TransactionId;
+   USHORT QMICTLType;      // QMICTL_CTL_SYNC_RESP
+   USHORT Length;
+   UCHAR  TLVType;         // QCTLV_TYPE_RESULT_CODE
+   USHORT TLVLength;       // 0x0004
+   USHORT QMIResult;
+   USHORT QMIError;
+} __attribute__ ((packed)) QMICTL_SYNC_RESP_MSG, *PQMICTL_SYNC_RESP_MSG;
+
+typedef struct _QMICTL_SYNC_IND_MSG
+{
+   UCHAR  CtlFlags;        // QMICTL_FLAG_INDICATION
+   UCHAR  TransactionId;
+   USHORT QMICTLType;      // QMICTL_REVOKE_CLIENT_ID_IND
+   USHORT Length;
+} __attribute__ ((packed)) QMICTL_SYNC_IND_MSG, *PQMICTL_SYNC_IND_MSG;
+
+typedef struct _QMICTL_MSG
+{
+   union
+   {
+      // Message Header
+      QCQMICTL_MSG_HDR                             QMICTLMsgHdr;
+      QCQMICTL_MSG_HDR_RESP                             QMICTLMsgHdrRsp;
+
+      // QMICTL Message
+      QMICTL_SET_INSTANCE_ID_REQ_MSG               SetInstanceIdReq;
+      QMICTL_SET_INSTANCE_ID_RESP_MSG              SetInstanceIdRsp;
+      QMICTL_GET_VERSION_REQ_MSG                   GetVersionReq;
+      QMICTL_GET_VERSION_RESP_MSG                  GetVersionRsp;
+      QMICTL_GET_CLIENT_ID_REQ_MSG                 GetClientIdReq;
+      QMICTL_GET_CLIENT_ID_RESP_MSG                GetClientIdRsp;
+      QMICTL_RELEASE_CLIENT_ID_REQ_MSG             ReleaseClientIdReq;
+      QMICTL_RELEASE_CLIENT_ID_RESP_MSG            ReleaseClientIdRsp;
+      QMICTL_REVOKE_CLIENT_ID_IND_MSG              RevokeClientIdInd;
+      QMICTL_INVALID_CLIENT_ID_IND_MSG             InvalidClientIdInd;
+      QMICTL_SET_DATA_FORMAT_REQ_MSG               SetDataFormatReq;
+      QMICTL_SET_DATA_FORMAT_RESP_MSG              SetDataFormatRsp;
+      QMICTL_SYNC_REQ_MSG                          SyncReq;
+      QMICTL_SYNC_RESP_MSG                         SyncRsp;
+      QMICTL_SYNC_IND_MSG                          SyncInd;
+   };
+} __attribute__ ((packed)) QMICTL_MSG, *PQMICTL_MSG;
+
+#endif // MPQCTL_H

root/package/link4all/quectel-CM/simcom-cm/MPQMI.h

@@ -0,0 +1,221 @@
+/*===========================================================================
+
+                            M P Q M I. H
+DESCRIPTION:
+
+    This module contains forward references to the QMI module.
+
+INITIALIZATION AND SEQUENCING REQUIREMENTS:
+
+Copyright (C) 2011 by Qualcomm Technologies, Incorporated.  All Rights Reserved.
+===========================================================================*/
+/*===========================================================================
+
+                            EDIT HISTORY FOR FILE
+  $Header: //depot/QMI/win/qcdrivers/ndis/MPQMI.h#3 $
+
+when        who    what, where, why
+--------    ---    ----------------------------------------------------------
+11/20/04    hg     Initial version.
+===========================================================================*/
+
+#ifndef USBQMI_H
+#define USBQMI_H
+
+typedef char    CHAR;
+typedef unsigned char   UCHAR;
+typedef unsigned short   USHORT;
+typedef int   INT;
+typedef unsigned int   UINT;
+typedef long    LONG;
+typedef unsigned int   ULONG;
+typedef unsigned long long   ULONG64;
+typedef char   *PCHAR;
+typedef unsigned char   *PUCHAR;
+typedef int   *PINT;
+typedef int   BOOL;
+
+#define TRUE (1 == 1)
+#define FALSE (1 != 1)
+
+#define QMICTL_SUPPORTED_MAJOR_VERSION 1
+#define QMICTL_SUPPORTED_MINOR_VERSION 0
+
+#pragma pack(push, 1)
+
+// ========= USB Control Message ==========
+
+#define USB_CTL_MSG_TYPE_QMI 0x01
+
+// USB Control Message
+typedef struct _QCUSB_CTL_MSG_HDR
+{
+   UCHAR IFType;
+} __attribute__ ((packed)) QCUSB_CTL_MSG_HDR, *PQCUSB_CTL_MSG_HDR;
+
+#define QCUSB_CTL_MSG_HDR_SIZE sizeof(QCUSB_CTL_MSG_HDR)
+
+typedef struct _QCUSB_CTL_MSG
+{
+   UCHAR IFType;
+   UCHAR Message;
+} __attribute__ ((packed)) QCUSB_CTL_MSG, *PQCUSB_CTL_MSG;
+
+#define QCTLV_TYPE_REQUIRED_PARAMETER 0x01
+#define QCTLV_TYPE_RESULT_CODE        0x02
+
+// ================= QMI ==================
+
+// Define QMI Type
+typedef enum _QMI_SERVICE_TYPE
+{
+   QMUX_TYPE_CTL  = 0x00,
+   QMUX_TYPE_WDS  = 0x01,
+   QMUX_TYPE_DMS  = 0x02,
+   QMUX_TYPE_NAS  = 0x03,
+   QMUX_TYPE_QOS  = 0x04,
+   QMUX_TYPE_WMS  = 0x05,
+   QMUX_TYPE_PDS  = 0x06,
+   QMUX_TYPE_UIM  = 0x0B,
+   QMUX_TYPE_WDS_IPV6  = 0x11,
+   QMUX_TYPE_WDS_ADMIN  = 0x1A,
+   QMUX_TYPE_MAX  = 0xFF,
+   QMUX_TYPE_ALL  = 0xFF
+} QMI_SERVICE_TYPE;
+
+typedef enum _QMI_RESULT_CODE_TYPE
+{
+   QMI_RESULT_SUCCESS = 0x0000,
+   QMI_RESULT_FAILURE = 0x0001
+} QMI_RESULT_CODE_TYPE;
+
+typedef enum _QMI_ERROR_CODE_TYPE
+{
+   QMI_ERR_NONE                 = 0x0000,
+   QMI_ERR_INTERNAL             = 0x0003,
+   QMI_ERR_CLIENT_IDS_EXHAUSTED = 0x0005,
+   QMI_ERR_DENIED               = 0x0006,
+   QMI_ERR_INVALID_CLIENT_IDS   = 0x0007,
+   QMI_ERR_NO_BATTERY           = 0x0008,
+   QMI_ERR_INVALID_HANDLE       = 0x0009,
+   QMI_ERR_INVALID_PROFILE      = 0x000A,
+   QMI_ERR_STORAGE_EXCEEDED     = 0x000B,
+   QMI_ERR_INCORRECT_PIN        = 0x000C,  
+   QMI_ERR_NO_NETWORK           = 0x000D,
+   QMI_ERR_PIN_LOCKED           = 0x000E,
+   QMI_ERR_OUT_OF_CALL          = 0x000F,
+   QMI_ERR_NOT_PROVISIONED      = 0x0010,
+   QMI_ERR_ARG_TOO_LONG         = 0x0013,
+   QMI_ERR_DEVICE_IN_USE        = 0x0017,
+   QMI_ERR_OP_DEVICE_UNSUPPORTED = 0x0019,
+   QMI_ERR_NO_EFFECT            = 0x001A, 
+   QMI_ERR_INVALID_ARG          = 0x0020,
+   QMI_ERR_NO_MEMORY            = 0x0021,
+   QMI_ERR_PIN_BLOCKED          = 0x0023,
+   QMI_ERR_PIN_PERM_BLOCKED     = 0x0024,
+   QMI_ERR_INVALID_INDEX        = 0x0031,
+   QMI_ERR_NO_ENTRY             = 0x0032,
+   QMI_ERR_EXTENDED_INTERNAL = 0x0051,
+   QMI_ERR_ACCESS_DENIED        = 0x0052
+} QMI_ERROR_CODE_TYPE;
+
+#define QCQMI_CTL_FLAG_SERVICE   0x80
+#define QCQMI_CTL_FLAG_CTL_POINT 0x00
+
+typedef struct _QCQMI_HDR
+{
+   UCHAR  IFType;
+   USHORT Length;
+   UCHAR  CtlFlags;  // reserved
+   UCHAR  QMIType;
+   UCHAR  ClientId;
+} __attribute__ ((packed)) QCQMI_HDR, *PQCQMI_HDR;
+
+#define QCQMI_HDR_SIZE (sizeof(QCQMI_HDR)-1)
+
+typedef struct _QCQMI
+{
+   UCHAR  IFType;
+   USHORT Length;
+   UCHAR  CtlFlags;  // reserved
+   UCHAR  QMIType;
+   UCHAR  ClientId;
+   UCHAR  SDU;
+} __attribute__ ((packed)) QCQMI, *PQCQMI;
+
+typedef struct _QMI_SERVICE_VERSION
+{
+   USHORT Major;
+   USHORT Minor;
+   USHORT AddendumMajor;
+   USHORT AddendumMinor;
+} __attribute__ ((packed)) QMI_SERVICE_VERSION, *PQMI_SERVICE_VERSION;
+
+// ================= QMUX ==================
+
+#define QMUX_MSG_OVERHEAD_BYTES 4  // Type(USHORT) Length(USHORT) -- header
+
+#define QMUX_BROADCAST_CID 0xFF
+
+typedef struct _QCQMUX_HDR
+{
+   UCHAR  CtlFlags;      // 0: single QMUX Msg; 1:
+   USHORT TransactionId;
+} __attribute__ ((packed)) QCQMUX_HDR, *PQCQMUX_HDR;
+
+typedef struct _QCQMUX
+{
+   UCHAR  CtlFlags;      // 0: single QMUX Msg; 1:
+   USHORT TransactionId;
+   UCHAR  Message;  // Type(2), Length(2), Value
+} __attribute__ ((packed)) QCQMUX, *PQCQMUX;
+
+#define QCQMUX_HDR_SIZE sizeof(QCQMUX_HDR)
+
+typedef struct _QCQMUX_MSG_HDR
+{
+   USHORT Type;
+   USHORT Length;
+} __attribute__ ((packed)) QCQMUX_MSG_HDR, *PQCQMUX_MSG_HDR;
+
+#define QCQMUX_MSG_HDR_SIZE sizeof(QCQMUX_MSG_HDR)
+
+typedef struct _QCQMUX_MSG_HDR_RESP
+{
+   USHORT Type;
+   USHORT Length;
+   UCHAR  TLVType;          // 0x02 - result code
+   USHORT TLVLength;        // 4
+   USHORT QMUXResult;       // QMI_RESULT_SUCCESS
+                            // QMI_RESULT_FAILURE
+   USHORT QMUXError;        // QMI_ERR_INVALID_ARG
+                            // QMI_ERR_NO_MEMORY
+                            // QMI_ERR_INTERNAL
+                            // QMI_ERR_FAULT
+} __attribute__ ((packed)) QCQMUX_MSG_HDR_RESP, *PQCQMUX_MSG_HDR_RESP;
+
+typedef struct _QCQMUX_TLV
+{
+   UCHAR Type;
+   USHORT Length;
+   UCHAR  Value;
+} __attribute__ ((packed)) QCQMUX_TLV, *PQCQMUX_TLV;
+
+typedef struct _QMI_TLV_HDR
+{
+   UCHAR  TLVType;
+   USHORT TLVLength;
+} __attribute__ ((packed)) QMI_TLV_HDR, *PQMI_TLV_HDR;
+
+// QMUX Message Definitions -- QMI SDU
+#define QMUX_CTL_FLAG_SINGLE_MSG    0x00
+#define QMUX_CTL_FLAG_COMPOUND_MSG  0x01
+#define QMUX_CTL_FLAG_TYPE_CMD      0x00
+#define QMUX_CTL_FLAG_TYPE_RSP      0x02
+#define QMUX_CTL_FLAG_TYPE_IND      0x04
+#define QMUX_CTL_FLAG_MASK_COMPOUND 0x01
+#define QMUX_CTL_FLAG_MASK_TYPE     0x06 // 00-cmd, 01-rsp, 10-ind
+
+#pragma pack(pop)
+
+#endif // USBQMI_H

root/package/link4all/quectel-CM/simcom-cm/MPQMUX.c

@@ -0,0 +1,424 @@
+#include "QMIThread.h"
+static char line[1024];
+static pthread_mutex_t dumpQMIMutex = PTHREAD_MUTEX_INITIALIZER;
+#undef dbg
+#define dbg( format, arg... ) do {if (strlen(line) < sizeof(line)) snprintf(&line[strlen(line)], sizeof(line) - strlen(line), format, ## arg);} while (0)
+
+PQMI_TLV_HDR GetTLV (PQCQMUX_MSG_HDR pQMUXMsgHdr, int TLVType);
+
+typedef struct {
+    UINT type;
+    const char *name;
+} QMI_NAME_T;
+
+#define qmi_name_item(type) {type, #type}
+
+static const QMI_NAME_T qmi_IFType[] = {
+{USB_CTL_MSG_TYPE_QMI, "USB_CTL_MSG_TYPE_QMI"},
+};
+
+static const QMI_NAME_T qmi_CtlFlags[] = {
+qmi_name_item(QMICTL_CTL_FLAG_CMD),
+qmi_name_item(QCQMI_CTL_FLAG_SERVICE),
+};
+
+static const QMI_NAME_T qmi_QMIType[] = {
+qmi_name_item(QMUX_TYPE_CTL),
+qmi_name_item(QMUX_TYPE_WDS),
+qmi_name_item(QMUX_TYPE_DMS),
+qmi_name_item(QMUX_TYPE_NAS),
+qmi_name_item(QMUX_TYPE_QOS),
+qmi_name_item(QMUX_TYPE_WMS),
+qmi_name_item(QMUX_TYPE_PDS),
+qmi_name_item(QMUX_TYPE_WDS_ADMIN),
+};
+
+static const QMI_NAME_T qmi_ctl_CtlFlags[] = {
+qmi_name_item(QMICTL_FLAG_REQUEST),
+qmi_name_item(QMICTL_FLAG_RESPONSE),
+qmi_name_item(QMICTL_FLAG_INDICATION),
+};
+
+static const QMI_NAME_T qmux_ctl_QMICTLType[] = {
+// QMICTL Type
+qmi_name_item(QMICTL_SET_INSTANCE_ID_REQ), //    0x0020
+qmi_name_item(QMICTL_SET_INSTANCE_ID_RESP), //   0x0020
+qmi_name_item(QMICTL_GET_VERSION_REQ), //        0x0021
+qmi_name_item(QMICTL_GET_VERSION_RESP), //       0x0021
+qmi_name_item(QMICTL_GET_CLIENT_ID_REQ), //      0x0022
+qmi_name_item(QMICTL_GET_CLIENT_ID_RESP), //     0x0022
+qmi_name_item(QMICTL_RELEASE_CLIENT_ID_REQ), //  0x0023
+qmi_name_item(QMICTL_RELEASE_CLIENT_ID_RESP), // 0x0023
+qmi_name_item(QMICTL_REVOKE_CLIENT_ID_IND), //   0x0024
+qmi_name_item(QMICTL_INVALID_CLIENT_ID_IND), //  0x0025
+qmi_name_item(QMICTL_SET_DATA_FORMAT_REQ), //    0x0026
+qmi_name_item(QMICTL_SET_DATA_FORMAT_RESP), //   0x0026
+qmi_name_item(QMICTL_SYNC_REQ), //               0x0027
+qmi_name_item(QMICTL_SYNC_RESP), //              0x0027
+qmi_name_item(QMICTL_SYNC_IND), //               0x0027
+};
+
+static const QMI_NAME_T qmux_CtlFlags[] = {
+qmi_name_item(QMUX_CTL_FLAG_TYPE_CMD),
+qmi_name_item(QMUX_CTL_FLAG_TYPE_RSP),
+qmi_name_item(QMUX_CTL_FLAG_TYPE_IND),
+};
+
+
+static const QMI_NAME_T qmux_wds_Type[] = {
+qmi_name_item(QMIWDS_SET_EVENT_REPORT_REQ), //           0x0001
+qmi_name_item(QMIWDS_SET_EVENT_REPORT_RESP), //          0x0001
+qmi_name_item(QMIWDS_EVENT_REPORT_IND), //               0x0001
+qmi_name_item(QMIWDS_START_NETWORK_INTERFACE_REQ), //    0x0020
+qmi_name_item(QMIWDS_START_NETWORK_INTERFACE_RESP), //   0x0020
+qmi_name_item(QMIWDS_STOP_NETWORK_INTERFACE_REQ), //     0x0021
+qmi_name_item(QMIWDS_STOP_NETWORK_INTERFACE_RESP), //    0x0021
+qmi_name_item(QMIWDS_GET_PKT_SRVC_STATUS_REQ), //        0x0022
+qmi_name_item(QMIWDS_GET_PKT_SRVC_STATUS_RESP), //       0x0022
+qmi_name_item(QMIWDS_GET_PKT_SRVC_STATUS_IND), //        0x0022  
+qmi_name_item(QMIWDS_GET_CURRENT_CHANNEL_RATE_REQ), //   0x0023  
+qmi_name_item(QMIWDS_GET_CURRENT_CHANNEL_RATE_RESP), //  0x0023  
+qmi_name_item(QMIWDS_GET_PKT_STATISTICS_REQ), //         0x0024  
+qmi_name_item(QMIWDS_GET_PKT_STATISTICS_RESP), //        0x0024  
+qmi_name_item(QMIWDS_MODIFY_PROFILE_SETTINGS_REQ), //    0x0028
+qmi_name_item(QMIWDS_MODIFY_PROFILE_SETTINGS_RESP), //   0x0028
+qmi_name_item(QMIWDS_GET_PROFILE_SETTINGS_REQ), //    0x002B
+qmi_name_item(QMIWDS_GET_PROFILE_SETTINGS_RESP), //   0x002BD
+qmi_name_item(QMIWDS_GET_DEFAULT_SETTINGS_REQ), //       0x002C
+qmi_name_item(QMIWDS_GET_DEFAULT_SETTINGS_RESP), //      0x002C
+qmi_name_item(QMIWDS_GET_RUNTIME_SETTINGS_REQ), //       0x002D
+qmi_name_item(QMIWDS_GET_RUNTIME_SETTINGS_RESP), //      0x002D
+qmi_name_item(QMIWDS_GET_MIP_MODE_REQ), //               0x002F
+qmi_name_item(QMIWDS_GET_MIP_MODE_RESP), //              0x002F
+qmi_name_item(QMIWDS_GET_DATA_BEARER_REQ), //            0x0037
+qmi_name_item(QMIWDS_GET_DATA_BEARER_RESP), //           0x0037
+qmi_name_item(QMIWDS_DUN_CALL_INFO_REQ), //              0x0038
+qmi_name_item(QMIWDS_DUN_CALL_INFO_RESP), //             0x0038
+qmi_name_item(QMIWDS_DUN_CALL_INFO_IND), //              0x0038
+qmi_name_item(QMIWDS_SET_CLIENT_IP_FAMILY_PREF_REQ), //  0x004D  
+qmi_name_item(QMIWDS_SET_CLIENT_IP_FAMILY_PREF_RESP), // 0x004D  
+qmi_name_item(QMIWDS_SET_AUTO_CONNECT_REQ), //  0x0051  
+qmi_name_item(QMIWDS_SET_AUTO_CONNECT_RESP), // 0x0051
+qmi_name_item(QMIWDS_BIND_MUX_DATA_PORT_REQ), //         0x00A2  
+qmi_name_item(QMIWDS_BIND_MUX_DATA_PORT_RESP), //        0x00A2  
+};
+
+static const QMI_NAME_T qmux_dms_Type[] = {
+// ======================= DMS ==============================
+qmi_name_item(QMIDMS_SET_EVENT_REPORT_REQ), //           0x0001
+qmi_name_item(QMIDMS_SET_EVENT_REPORT_RESP), //          0x0001
+qmi_name_item(QMIDMS_EVENT_REPORT_IND), //               0x0001
+qmi_name_item(QMIDMS_GET_DEVICE_CAP_REQ), //             0x0020
+qmi_name_item(QMIDMS_GET_DEVICE_CAP_RESP), //            0x0020
+qmi_name_item(QMIDMS_GET_DEVICE_MFR_REQ), //             0x0021
+qmi_name_item(QMIDMS_GET_DEVICE_MFR_RESP), //            0x0021
+qmi_name_item(QMIDMS_GET_DEVICE_MODEL_ID_REQ), //        0x0022
+qmi_name_item(QMIDMS_GET_DEVICE_MODEL_ID_RESP), //       0x0022
+qmi_name_item(QMIDMS_GET_DEVICE_REV_ID_REQ), //          0x0023
+qmi_name_item(QMIDMS_GET_DEVICE_REV_ID_RESP), //         0x0023
+qmi_name_item(QMIDMS_GET_MSISDN_REQ), //                 0x0024
+qmi_name_item(QMIDMS_GET_MSISDN_RESP), //                0x0024
+qmi_name_item(QMIDMS_GET_DEVICE_SERIAL_NUMBERS_REQ), //  0x0025
+qmi_name_item(QMIDMS_GET_DEVICE_SERIAL_NUMBERS_RESP), // 0x0025
+qmi_name_item(QMIDMS_UIM_SET_PIN_PROTECTION_REQ), //     0x0027
+qmi_name_item(QMIDMS_UIM_SET_PIN_PROTECTION_RESP), //    0x0027
+qmi_name_item(QMIDMS_UIM_VERIFY_PIN_REQ), //             0x0028
+qmi_name_item(QMIDMS_UIM_VERIFY_PIN_RESP), //            0x0028
+qmi_name_item(QMIDMS_UIM_UNBLOCK_PIN_REQ), //            0x0029
+qmi_name_item(QMIDMS_UIM_UNBLOCK_PIN_RESP), //           0x0029
+qmi_name_item(QMIDMS_UIM_CHANGE_PIN_REQ), //             0x002A
+qmi_name_item(QMIDMS_UIM_CHANGE_PIN_RESP), //            0x002A
+qmi_name_item(QMIDMS_UIM_GET_PIN_STATUS_REQ), //         0x002B
+qmi_name_item(QMIDMS_UIM_GET_PIN_STATUS_RESP), //        0x002B
+qmi_name_item(QMIDMS_GET_DEVICE_HARDWARE_REV_REQ), //    0x002C
+qmi_name_item(QMIDMS_GET_DEVICE_HARDWARE_REV_RESP), //   0x002C
+qmi_name_item(QMIDMS_GET_OPERATING_MODE_REQ), //         0x002D 
+qmi_name_item(QMIDMS_GET_OPERATING_MODE_RESP), //        0x002D 
+qmi_name_item(QMIDMS_SET_OPERATING_MODE_REQ), //         0x002E 
+qmi_name_item(QMIDMS_SET_OPERATING_MODE_RESP), //        0x002E 
+qmi_name_item(QMIDMS_GET_ACTIVATED_STATUS_REQ), //       0x0031 
+qmi_name_item(QMIDMS_GET_ACTIVATED_STATUS_RESP), //      0x0031 
+qmi_name_item(QMIDMS_ACTIVATE_AUTOMATIC_REQ), //         0x0032
+qmi_name_item(QMIDMS_ACTIVATE_AUTOMATIC_RESP), //        0x0032
+qmi_name_item(QMIDMS_ACTIVATE_MANUAL_REQ), //            0x0033
+qmi_name_item(QMIDMS_ACTIVATE_MANUAL_RESP), //           0x0033
+qmi_name_item(QMIDMS_UIM_GET_ICCID_REQ), //              0x003C 
+qmi_name_item(QMIDMS_UIM_GET_ICCID_RESP), //             0x003C 
+qmi_name_item(QMIDMS_UIM_GET_CK_STATUS_REQ), //          0x0040
+qmi_name_item(QMIDMS_UIM_GET_CK_STATUS_RESP), //         0x0040
+qmi_name_item(QMIDMS_UIM_SET_CK_PROTECTION_REQ), //      0x0041
+qmi_name_item(QMIDMS_UIM_SET_CK_PROTECTION_RESP), //     0x0041
+qmi_name_item(QMIDMS_UIM_UNBLOCK_CK_REQ), //             0x0042
+qmi_name_item(QMIDMS_UIM_UNBLOCK_CK_RESP), //            0x0042
+qmi_name_item(QMIDMS_UIM_GET_IMSI_REQ), //               0x0043 
+qmi_name_item(QMIDMS_UIM_GET_IMSI_RESP), //              0x0043 
+qmi_name_item(QMIDMS_UIM_GET_STATE_REQ), //              0x0044 
+qmi_name_item(QMIDMS_UIM_GET_STATE_RESP), //             0x0044 
+qmi_name_item(QMIDMS_GET_BAND_CAP_REQ), //               0x0045 
+qmi_name_item(QMIDMS_GET_BAND_CAP_RESP), //              0x0045 
+};
+
+static const QMI_NAME_T qmux_nas_Type[] = {
+// ======================= NAS ==============================
+qmi_name_item(QMINAS_SET_EVENT_REPORT_REQ), //             0x0002
+qmi_name_item(QMINAS_SET_EVENT_REPORT_RESP), //            0x0002
+qmi_name_item(QMINAS_EVENT_REPORT_IND), //                 0x0002
+qmi_name_item(QMINAS_GET_SIGNAL_STRENGTH_REQ), //          0x0020
+qmi_name_item(QMINAS_GET_SIGNAL_STRENGTH_RESP), //         0x0020
+qmi_name_item(QMINAS_PERFORM_NETWORK_SCAN_REQ), //         0x0021
+qmi_name_item(QMINAS_PERFORM_NETWORK_SCAN_RESP), //        0x0021
+qmi_name_item(QMINAS_INITIATE_NW_REGISTER_REQ), //         0x0022
+qmi_name_item(QMINAS_INITIATE_NW_REGISTER_RESP), //        0x0022
+qmi_name_item(QMINAS_INITIATE_ATTACH_REQ), //              0x0023
+qmi_name_item(QMINAS_INITIATE_ATTACH_RESP), //             0x0023
+qmi_name_item(QMINAS_GET_SERVING_SYSTEM_REQ), //           0x0024
+qmi_name_item(QMINAS_GET_SERVING_SYSTEM_RESP), //          0x0024
+qmi_name_item(QMINAS_SERVING_SYSTEM_IND), //               0x0024
+qmi_name_item(QMINAS_GET_HOME_NETWORK_REQ), //             0x0025
+qmi_name_item(QMINAS_GET_HOME_NETWORK_RESP), //            0x0025
+qmi_name_item(QMINAS_GET_PREFERRED_NETWORK_REQ), //        0x0026
+qmi_name_item(QMINAS_GET_PREFERRED_NETWORK_RESP), //       0x0026
+qmi_name_item(QMINAS_SET_PREFERRED_NETWORK_REQ), //        0x0027
+qmi_name_item(QMINAS_SET_PREFERRED_NETWORK_RESP), //       0x0027
+qmi_name_item(QMINAS_GET_FORBIDDEN_NETWORK_REQ), //        0x0028
+qmi_name_item(QMINAS_GET_FORBIDDEN_NETWORK_RESP), //       0x0028
+qmi_name_item(QMINAS_SET_FORBIDDEN_NETWORK_REQ), //        0x0029
+qmi_name_item(QMINAS_SET_FORBIDDEN_NETWORK_RESP), //       0x0029
+qmi_name_item(QMINAS_SET_TECHNOLOGY_PREF_REQ), //          0x002A
+qmi_name_item(QMINAS_SET_TECHNOLOGY_PREF_RESP), //         0x002A
+qmi_name_item(QMINAS_GET_RF_BAND_INFO_REQ), //             0x0031
+qmi_name_item(QMINAS_GET_RF_BAND_INFO_RESP), //            0x0031
+qmi_name_item(QMINAS_GET_PLMN_NAME_REQ), //                0x0044
+qmi_name_item(QMINAS_GET_PLMN_NAME_RESP), //               0x0044
+qmi_name_item(QUECTEL_PACKET_TRANSFER_START_IND), //                0X100
+qmi_name_item(QUECTEL_PACKET_TRANSFER_END_IND), //               0X101
+qmi_name_item(QMINAS_GET_SYS_INFO_REQ), //                 0x004D
+qmi_name_item(QMINAS_GET_SYS_INFO_RESP), //                0x004D
+qmi_name_item(QMINAS_SYS_INFO_IND), //                     0x004D
+};
+
+static const QMI_NAME_T qmux_wms_Type[] = {
+// ======================= WMS ==============================
+qmi_name_item(QMIWMS_SET_EVENT_REPORT_REQ), //           0x0001
+qmi_name_item(QMIWMS_SET_EVENT_REPORT_RESP), //          0x0001
+qmi_name_item(QMIWMS_EVENT_REPORT_IND), //               0x0001
+qmi_name_item(QMIWMS_RAW_SEND_REQ), //                   0x0020
+qmi_name_item(QMIWMS_RAW_SEND_RESP), //                  0x0020
+qmi_name_item(QMIWMS_RAW_WRITE_REQ), //                  0x0021
+qmi_name_item(QMIWMS_RAW_WRITE_RESP), //                 0x0021
+qmi_name_item(QMIWMS_RAW_READ_REQ), //                   0x0022
+qmi_name_item(QMIWMS_RAW_READ_RESP), //                  0x0022
+qmi_name_item(QMIWMS_MODIFY_TAG_REQ), //                 0x0023
+qmi_name_item(QMIWMS_MODIFY_TAG_RESP), //                0x0023
+qmi_name_item(QMIWMS_DELETE_REQ), //                     0x0024
+qmi_name_item(QMIWMS_DELETE_RESP), //                    0x0024
+qmi_name_item(QMIWMS_GET_MESSAGE_PROTOCOL_REQ), //       0x0030
+qmi_name_item(QMIWMS_GET_MESSAGE_PROTOCOL_RESP), //      0x0030
+qmi_name_item(QMIWMS_LIST_MESSAGES_REQ), //              0x0031
+qmi_name_item(QMIWMS_LIST_MESSAGES_RESP), //             0x0031
+qmi_name_item(QMIWMS_GET_SMSC_ADDRESS_REQ), //           0x0034
+qmi_name_item(QMIWMS_GET_SMSC_ADDRESS_RESP), //          0x0034
+qmi_name_item(QMIWMS_SET_SMSC_ADDRESS_REQ), //           0x0035
+qmi_name_item(QMIWMS_SET_SMSC_ADDRESS_RESP), //          0x0035
+qmi_name_item(QMIWMS_GET_STORE_MAX_SIZE_REQ), //         0x0036
+qmi_name_item(QMIWMS_GET_STORE_MAX_SIZE_RESP), //        0x0036
+};
+
+static const QMI_NAME_T qmux_wds_admin_Type[] = {
+qmi_name_item(QMIWDS_ADMIN_SET_DATA_FORMAT_REQ), //      0x0020
+qmi_name_item(QMIWDS_ADMIN_SET_DATA_FORMAT_RESP), //     0x0020
+qmi_name_item(QMIWDS_ADMIN_GET_DATA_FORMAT_REQ), //      0x0021
+qmi_name_item(QMIWDS_ADMIN_GET_DATA_FORMAT_RESP), //     0x0021
+qmi_name_item(QMIWDS_ADMIN_SET_QMAP_SETTINGS_REQ), //    0x002B
+qmi_name_item(QMIWDS_ADMIN_SET_QMAP_SETTINGS_RESP), //   0x002B
+qmi_name_item(QMIWDS_ADMIN_GET_QMAP_SETTINGS_REQ), //    0x002C
+qmi_name_item(QMIWDS_ADMIN_GET_QMAP_SETTINGS_RESP), //   0x002C
+};
+
+static const QMI_NAME_T qmux_uim_Type[] = {
+qmi_name_item( QMIUIM_READ_TRANSPARENT_REQ), //      0x0020
+qmi_name_item( QMIUIM_READ_TRANSPARENT_RESP), //     0x0020
+qmi_name_item( QMIUIM_READ_TRANSPARENT_IND), //      0x0020
+qmi_name_item( QMIUIM_READ_RECORD_REQ), //           0x0021
+qmi_name_item( QMIUIM_READ_RECORD_RESP), //          0x0021
+qmi_name_item( QMIUIM_READ_RECORD_IND), //           0x0021
+qmi_name_item( QMIUIM_WRITE_TRANSPARENT_REQ), //     0x0022
+qmi_name_item( QMIUIM_WRITE_TRANSPARENT_RESP), //    0x0022
+qmi_name_item( QMIUIM_WRITE_TRANSPARENT_IND), //     0x0022
+qmi_name_item( QMIUIM_WRITE_RECORD_REQ), //          0x0023
+qmi_name_item( QMIUIM_WRITE_RECORD_RESP), //         0x0023
+qmi_name_item( QMIUIM_WRITE_RECORD_IND), //          0x0023
+qmi_name_item( QMIUIM_SET_PIN_PROTECTION_REQ), //    0x0025
+qmi_name_item( QMIUIM_SET_PIN_PROTECTION_RESP), //   0x0025
+qmi_name_item( QMIUIM_SET_PIN_PROTECTION_IND), //    0x0025
+qmi_name_item( QMIUIM_VERIFY_PIN_REQ), //            0x0026
+qmi_name_item( QMIUIM_VERIFY_PIN_RESP), //           0x0026
+qmi_name_item( QMIUIM_VERIFY_PIN_IND), //            0x0026
+qmi_name_item( QMIUIM_UNBLOCK_PIN_REQ), //           0x0027
+qmi_name_item( QMIUIM_UNBLOCK_PIN_RESP), //          0x0027
+qmi_name_item( QMIUIM_UNBLOCK_PIN_IND), //           0x0027
+qmi_name_item( QMIUIM_CHANGE_PIN_REQ), //            0x0028
+qmi_name_item( QMIUIM_CHANGE_PIN_RESP), //           0x0028
+qmi_name_item( QMIUIM_CHANGE_PIN_IND), //            0x0028
+qmi_name_item( QMIUIM_DEPERSONALIZATION_REQ), //     0x0029
+qmi_name_item( QMIUIM_DEPERSONALIZATION_RESP), //    0x0029
+qmi_name_item( QMIUIM_EVENT_REG_REQ), //             0x002E
+qmi_name_item( QMIUIM_EVENT_REG_RESP), //            0x002E
+qmi_name_item( QMIUIM_GET_CARD_STATUS_REQ), //       0x002F
+qmi_name_item( QMIUIM_GET_CARD_STATUS_RESP), //      0x002F
+qmi_name_item( QMIUIM_STATUS_CHANGE_IND), //         0x0032
+};
+
+static const char * qmi_name_get(const QMI_NAME_T *table, size_t size, int type, const char *tag) {
+    static char unknow[40];
+    size_t i;
+
+    if (qmux_CtlFlags == table) {
+        if (!strcmp(tag, "_REQ"))
+            tag = "_CMD";
+        else  if (!strcmp(tag, "_RESP"))
+            tag = "_RSP";
+    }
+    
+    for (i = 0; i < size; i++) {
+        if (table[i].type == (UINT)type) {
+            if (!tag || (strstr(table[i].name, tag)))
+                return table[i].name;
+        }
+    }
+    sprintf(unknow, "unknow_%x", type);
+    return unknow;
+}
+
+#define QMI_NAME(table, type) qmi_name_get(table, sizeof(table) / sizeof(table[0]), type, 0)
+#define QMUX_NAME(table, type, tag) qmi_name_get(table, sizeof(table) / sizeof(table[0]), type, tag)
+
+void dump_tlv(PQCQMUX_MSG_HDR pQMUXMsgHdr) {
+    int TLVFind = 0;
+    int i;
+    //dbg("QCQMUX_TLV-----------------------------------\n");
+    //dbg("{Type,\tLength,\tValue}\n");
+
+    while (1) {
+        PQMI_TLV_HDR TLVHdr = GetTLV(pQMUXMsgHdr, 0x1000 + (++TLVFind));
+        if (TLVHdr == NULL)
+            break;
+
+        //if ((TLVHdr->TLVType == 0x02) && ((USHORT *)(TLVHdr+1))[0])
+        {        
+            dbg("{%02x,\t%04x,\t", TLVHdr->TLVType, le16_to_cpu(TLVHdr->TLVLength));
+            for (i = 0; i < le16_to_cpu(TLVHdr->TLVLength); i++) {
+                dbg("%02x ", ((UCHAR *)(TLVHdr+1))[i]);
+            }
+            dbg("}\n");
+        }
+    }  // while
+}
+
+void dump_ctl(PQCQMICTL_MSG_HDR CTLHdr) {
+    const char *tag;
+    
+    //dbg("QCQMICTL_MSG--------------------------------------------\n");
+    //dbg("CtlFlags:           %02x\t\t%s\n", CTLHdr->CtlFlags, QMI_NAME(qmi_ctl_CtlFlags, CTLHdr->CtlFlags));
+   dbg("TransactionId:      %02x\n", CTLHdr->TransactionId);
+        switch (CTLHdr->CtlFlags) {
+            case QMICTL_FLAG_REQUEST: tag = "_REQ"; break;
+            case QMICTL_FLAG_RESPONSE: tag = "_RESP"; break;
+            case QMICTL_FLAG_INDICATION: tag = "_IND"; break;
+            default: tag = 0; break;
+       }
+        dbg("QMICTLType:         %04x\t%s\n", le16_to_cpu(CTLHdr->QMICTLType),
+        QMUX_NAME(qmux_ctl_QMICTLType, le16_to_cpu(CTLHdr->QMICTLType), tag));     
+        dbg("Length:             %04x\n", le16_to_cpu(CTLHdr->Length));
+
+     dump_tlv((PQCQMUX_MSG_HDR)(&CTLHdr->QMICTLType));
+}
+
+int dump_qmux(QMI_SERVICE_TYPE serviceType, PQCQMUX_HDR QMUXHdr) {
+    PQCQMUX_MSG_HDR QMUXMsgHdr = (PQCQMUX_MSG_HDR) (QMUXHdr + 1);
+    CHAR *tag;
+
+    //dbg("QCQMUX--------------------------------------------\n");
+    switch (QMUXHdr->CtlFlags&QMUX_CTL_FLAG_MASK_TYPE) {
+        case QMUX_CTL_FLAG_TYPE_CMD: tag = "_REQ"; break;
+        case QMUX_CTL_FLAG_TYPE_RSP: tag = "_RESP"; break;
+        case QMUX_CTL_FLAG_TYPE_IND: tag = "_IND"; break;
+        default: tag = 0; break;
+    }
+    //dbg("CtlFlags:           %02x\t\t%s\n", QMUXHdr->CtlFlags, QMUX_NAME(qmux_CtlFlags, QMUXHdr->CtlFlags, tag));
+    dbg("TransactionId:    %04x\n", le16_to_cpu(QMUXHdr->TransactionId));
+
+    //dbg("QCQMUX_MSG_HDR-----------------------------------\n");
+    switch (serviceType) {
+        case QMUX_TYPE_DMS:
+            dbg("Type:               %04x\t%s\n", le16_to_cpu(QMUXMsgHdr->Type),
+            QMUX_NAME(qmux_dms_Type, le16_to_cpu(QMUXMsgHdr->Type), tag));
+        break;
+        case QMUX_TYPE_NAS:
+            dbg("Type:               %04x\t%s\n", le16_to_cpu(QMUXMsgHdr->Type),
+            QMUX_NAME(qmux_nas_Type, le16_to_cpu(QMUXMsgHdr->Type), tag));
+        break;
+        case QMUX_TYPE_WDS:
+            dbg("Type:               %04x\t%s\n", le16_to_cpu(QMUXMsgHdr->Type),
+            QMUX_NAME(qmux_wds_Type, le16_to_cpu(QMUXMsgHdr->Type), tag));
+        break;
+        case QMUX_TYPE_WMS:
+            dbg("Type:               %04x\t%s\n", le16_to_cpu(QMUXMsgHdr->Type),
+            QMUX_NAME(qmux_wms_Type, le16_to_cpu(QMUXMsgHdr->Type), tag));
+        break;
+        case QMUX_TYPE_WDS_ADMIN:
+            dbg("Type:               %04x\t%s\n", le16_to_cpu(QMUXMsgHdr->Type),
+            QMUX_NAME(qmux_wds_admin_Type, le16_to_cpu(QMUXMsgHdr->Type), tag));
+        break;
+        case QMUX_TYPE_UIM:
+            dbg("Type:               %04x\t%s\n", le16_to_cpu(QMUXMsgHdr->Type),
+            QMUX_NAME(qmux_uim_Type, le16_to_cpu(QMUXMsgHdr->Type), tag));
+        break;
+        case QMUX_TYPE_PDS:
+        case QMUX_TYPE_QOS:
+        case QMUX_TYPE_CTL:                
+        default:
+            dbg("Type:               %04x\t%s\n", le16_to_cpu(QMUXMsgHdr->Type), "PDS/QOS/CTL/unknown!");
+        break;    
+    }
+    dbg("Length:             %04x\n", le16_to_cpu(QMUXMsgHdr->Length));
+
+    dump_tlv(QMUXMsgHdr);
+    
+    return 0;
+}
+
+void dump_qmi(void *dataBuffer, int dataLen) 
+{
+    PQCQMI_HDR QMIHdr = (PQCQMI_HDR)dataBuffer;
+    PQCQMUX_HDR QMUXHdr = (PQCQMUX_HDR) (QMIHdr + 1);
+    PQCQMICTL_MSG_HDR CTLHdr =  (PQCQMICTL_MSG_HDR) (QMIHdr + 1);
+
+    int i;
+
+    if (!debug_qmi)
+        return;
+
+    pthread_mutex_lock(&dumpQMIMutex);
+    line[0] = 0;
+    for (i = 0; i < dataLen; i++) {
+        dbg("%02x ", ((unsigned char *)dataBuffer)[i]);
+    }
+    dbg_time("%s", line);
+    line[0] = 0;
+    
+    //dbg("QCQMI_HDR-----------------------------------------");
+    //dbg("IFType:             %02x\t\t%s", QMIHdr->IFType, QMI_NAME(qmi_IFType, QMIHdr->IFType));
+    //dbg("Length:             %04x", le16_to_cpu(QMIHdr->Length));
+    //dbg("CtlFlags:           %02x\t\t%s", QMIHdr->CtlFlags, QMI_NAME(qmi_CtlFlags, QMIHdr->CtlFlags));
+    //dbg("QMIType:            %02x\t\t%s", QMIHdr->QMIType, QMI_NAME(qmi_QMIType, QMIHdr->QMIType));
+    //dbg("ClientId:           %02x", QMIHdr->ClientId);
+
+    if (QMIHdr->QMIType == QMUX_TYPE_CTL) {
+        dump_ctl(CTLHdr);
+    } else {
+        dump_qmux(QMIHdr->QMIType, QMUXHdr);
+    }
+    dbg_time("%s", line);
+    pthread_mutex_unlock(&dumpQMIMutex);
+}

root/package/link4all/quectel-CM/simcom-cm/Makefile

@@ -0,0 +1,24 @@
+#CROSS_COMPILE=arm-hisiv100nptl-linux-
+# ifneq ($(CROSS_COMPILE),)
+# CROSS-COMPILE:=$(CROSS_COMPILE)
+# endif
+
+# CC:=$(CROSS-COMPILE)gcc
+# LD:=$(CROSS-COMPILE)ld
+
+# release: clean
+# 	$(CC) -Wall -s QmiWwanCM.c GobiNetCM.c main.c MPQMUX.c QMIThread.c util.c udhcpc.c -o simcom-cm -lpthread
+
+# debug: clean
+# 	$(CC) -Wall -g QmiWwanCM.c GobiNetCM.c main.c MPQMUX.c QMIThread.c util.c udhcpc.c -o simcom-cm -lpthread
+
+# clean:
+# 	rm -rf simcom-cm *~
+
+
+quectel-CM:clean
+	$(CC) -Wall -s QmiWwanCM.c GobiNetCM.c main.c MPQMUX.c QMIThread.c util.c udhcpc.c -o quectel-CM -lpthread
+
+clean:
+	rm -rf quectel-CM *~
+

root/package/link4all/quectel-CM/simcom-cm/QMIThread.h

@@ -0,0 +1,174 @@
+#ifndef __QMI_THREAD_H__
+#define __QMI_THREAD_H__
+
+#define CONFIG_GOBINET
+#define CONFIG_QMIWWAN
+#define CONFIG_SIM
+//#define CONFIG_APN
+#define CONFIG_VERSION
+#define CONFIG_DEFAULT_PDP 1
+//#define CONFIG_IMSI_ICCID
+#ifndef ANDROID
+#define CONFIG_RESET_RADIO (45) //Reset Radiao(AT+CFUN=4,AT+CFUN=1) when cann not register network or setup data call in 45 seconds
+#endif
+
+#include <stdio.h>
+#include <string.h>
+#include <termios.h>
+#include <stdio.h>
+#include <ctype.h>
+#include <time.h>
+#include <fcntl.h>
+#include <signal.h>
+#include <errno.h>
+#include <string.h>
+#include <stdlib.h>
+#include <unistd.h>
+#include <errno.h>
+#include <pthread.h>
+#include <sys/types.h>
+#include <sys/stat.h>
+#include <sys/epoll.h>
+#include <sys/poll.h>
+#include <sys/ioctl.h>
+#include <sys/socket.h>
+#include <stddef.h>
+
+#include "MPQMI.h"
+#include "MPQCTL.h"
+#include "MPQMUX.h"
+
+#define DEVICE_CLASS_UNKNOWN           0
+#define DEVICE_CLASS_CDMA              1
+#define DEVICE_CLASS_GSM               2
+
+#define WWAN_DATA_CLASS_NONE            0x00000000
+#define WWAN_DATA_CLASS_GPRS            0x00000001
+#define WWAN_DATA_CLASS_EDGE            0x00000002 /* EGPRS */
+#define WWAN_DATA_CLASS_UMTS            0x00000004
+#define WWAN_DATA_CLASS_HSDPA           0x00000008
+#define WWAN_DATA_CLASS_HSUPA           0x00000010
+#define WWAN_DATA_CLASS_LTE             0x00000020
+#define WWAN_DATA_CLASS_1XRTT           0x00010000
+#define WWAN_DATA_CLASS_1XEVDO          0x00020000
+#define WWAN_DATA_CLASS_1XEVDO_REVA     0x00040000
+#define WWAN_DATA_CLASS_1XEVDV          0x00080000
+#define WWAN_DATA_CLASS_3XRTT           0x00100000
+#define WWAN_DATA_CLASS_1XEVDO_REVB     0x00200000 /* for future use */
+#define WWAN_DATA_CLASS_UMB             0x00400000
+#define WWAN_DATA_CLASS_CUSTOM          0x80000000
+
+struct wwan_data_class_str {
+    ULONG class;
+    CHAR *str;
+};
+
+#pragma pack(push, 1)
+
+typedef struct _QCQMIMSG {
+    QCQMI_HDR QMIHdr;
+    union {
+        QMICTL_MSG CTLMsg;
+        QMUX_MSG MUXMsg;
+    };
+} __attribute__ ((packed)) QCQMIMSG, *PQCQMIMSG;
+
+#pragma pack(pop)
+
+typedef struct __IPV4 {
+    uint32_t Address;
+    uint32_t Gateway;
+    uint32_t SubnetMask;
+    uint32_t DnsPrimary;
+    uint32_t DnsSecondary;
+    uint32_t Mtu;
+} IPV4_T;
+
+typedef struct __IPV6 {
+    UCHAR Address[16];
+    UCHAR Gateway[16];
+    UCHAR SubnetMask[16];
+    UCHAR DnsPrimary[16];
+    UCHAR DnsSecondary[16];
+    UCHAR PrefixLengthIPAddr;
+    UCHAR PrefixLengthGateway;
+    ULONG Mtu;
+} IPV6_T;
+
+#define IpFamilyV4 (0x04)
+#define IpFamilyV6 (0x06)
+typedef struct __PROFILE {
+    char * qmichannel;
+    char * usbnet_adapter;
+    const char *apn;
+    const char *user;
+    const char *password;
+    const char *pincode;
+    int auth;
+    int pdp;
+    int IsDualIPSupported;
+    int curIpFamily;
+    int rawIP;
+    IPV4_T ipv4;
+    IPV6_T ipv6;
+} PROFILE_T;
+
+typedef enum {
+    SIM_ABSENT = 0,
+    SIM_NOT_READY = 1,
+    SIM_READY = 2, /* SIM_READY means the radio state is RADIO_STATE_SIM_READY */
+    SIM_PIN = 3,
+    SIM_PUK = 4,
+    SIM_NETWORK_PERSONALIZATION = 5,
+    SIM_BAD = 6,
+} SIM_Status;
+
+#define WDM_DEFAULT_BUFSIZE	256
+#define RIL_REQUEST_QUIT    0x1000
+#define RIL_INDICATE_DEVICE_CONNECTED    0x1002
+#define RIL_INDICATE_DEVICE_DISCONNECTED    0x1003
+#define RIL_UNSOL_RESPONSE_VOICE_NETWORK_STATE_CHANGED    0x1004
+#define RIL_UNSOL_DATA_CALL_LIST_CHANGED    0x1005
+
+extern int pthread_cond_timeout_np(pthread_cond_t *cond, pthread_mutex_t * mutex, unsigned msecs);
+extern int QmiThreadSendQMI(PQCQMIMSG pRequest, PQCQMIMSG *ppResponse);
+extern int QmiThreadSendQMITimeout(PQCQMIMSG pRequest, PQCQMIMSG *ppResponse, unsigned msecs);
+extern void QmiThreadRecvQMI(PQCQMIMSG pResponse);
+extern int QmiWwanInit(PROFILE_T *profile);
+extern int QmiWwanDeInit(void);
+extern int QmiWwanSendQMI(PQCQMIMSG pRequest);
+extern void * QmiWwanThread(void *pData);
+extern int GobiNetSendQMI(PQCQMIMSG pRequest);
+extern void * GobiNetThread(void *pData);
+extern void udhcpc_start(PROFILE_T *profile);
+extern void udhcpc_stop(PROFILE_T *profile);
+extern void dump_qmi(void *dataBuffer, int dataLen);
+extern void qmidevice_send_event_to_main(int triger_event);
+extern int requestSetEthMode(PROFILE_T *profile);
+extern int requestGetSIMStatus(SIM_Status *pSIMStatus);
+extern int requestEnterSimPin(const CHAR *pPinCode);
+extern int requestGetICCID(void);
+extern int requestGetIMSI(void);
+extern int requestRegistrationState(UCHAR *pPSAttachedState);
+extern int requestQueryDataCall(UCHAR  *pConnectionStatus, int curIpFamily);
+extern int requestSetupDataCall(PROFILE_T *profile, int curIpFamily);
+extern int requestDeactivateDefaultPDP(PROFILE_T *profile, int curIpFamily);
+extern int requestSetProfile(PROFILE_T *profile);
+extern int requestGetProfile(PROFILE_T *profile);
+extern int requestBaseBandVersion(const char **pp_reversion);
+extern int requestGetIPAddress(PROFILE_T *profile, int curIpFamily);
+extern int requestSetOperatingMode(UCHAR OperatingMode);
+
+extern FILE *logfilefp;
+extern int debug_qmi;
+extern char * qmichannel;
+extern int qmidevice_control_fd[2];
+extern int qmiclientId[QMUX_TYPE_WDS_ADMIN + 1];
+extern int cdc_wdm_fd;
+extern void dbg_time (const char *fmt, ...);
+extern USHORT le16_to_cpu(USHORT v16);
+extern UINT  le32_to_cpu (UINT v32);
+extern UINT  sc_swap32(UINT v32);
+extern USHORT cpu_to_le16(USHORT v16);
+extern UINT cpu_to_le32(UINT v32);
+#endif

root/package/link4all/quectel-CM/simcom-cm/QmiWwanCM.c

@@ -0,0 +1,281 @@
+#include <stdio.h>
+#include <string.h>
+#include <termios.h>
+#include <stdio.h>
+#include <ctype.h>
+#include "QMIThread.h"
+
+#ifdef CONFIG_QMIWWAN
+int cdc_wdm_fd = -1;
+static UCHAR GetQCTLTransactionId(void) {
+    static int TransactionId = 0;
+    if (++TransactionId > 0xFF)
+        TransactionId = 1;
+    return TransactionId;
+}
+
+typedef USHORT (*CUSTOMQCTL)(PQMICTL_MSG pCTLMsg, void *arg);
+
+static PQCQMIMSG ComposeQCTLMsg(USHORT QMICTLType, CUSTOMQCTL customQctlMsgFunction, void *arg) {
+    UCHAR QMIBuf[WDM_DEFAULT_BUFSIZE];
+    PQCQMIMSG pRequest = (PQCQMIMSG)QMIBuf;
+    int Length;
+
+    pRequest->QMIHdr.IFType   = USB_CTL_MSG_TYPE_QMI;
+    pRequest->QMIHdr.CtlFlags = 0x00;
+    pRequest->QMIHdr.QMIType  = QMUX_TYPE_CTL;
+    pRequest->QMIHdr.ClientId= 0x00;
+
+    pRequest->CTLMsg.QMICTLMsgHdr.CtlFlags = QMICTL_FLAG_REQUEST;
+    pRequest->CTLMsg.QMICTLMsgHdr.TransactionId = GetQCTLTransactionId();
+    pRequest->CTLMsg.QMICTLMsgHdr.QMICTLType = cpu_to_le16(QMICTLType);
+    if (customQctlMsgFunction)
+        pRequest->CTLMsg.QMICTLMsgHdr.Length = cpu_to_le16(customQctlMsgFunction(&pRequest->CTLMsg, arg) - sizeof(QCQMICTL_MSG_HDR));
+    else
+        pRequest->CTLMsg.QMICTLMsgHdr.Length = cpu_to_le16(0x0000);
+
+    pRequest->QMIHdr.Length = cpu_to_le16(le16_to_cpu(pRequest->CTLMsg.QMICTLMsgHdr.Length) + sizeof(QCQMICTL_MSG_HDR) + sizeof(QCQMI_HDR) - 1);
+    Length = le16_to_cpu(pRequest->QMIHdr.Length) + 1;
+
+    pRequest = (PQCQMIMSG)malloc(Length);
+    if (pRequest == NULL) {
+        dbg_time("%s fail to malloc", __func__);
+    } else {
+        memcpy(pRequest, QMIBuf, Length);
+    }
+
+    return pRequest;
+}
+
+static USHORT CtlGetVersionReq(PQMICTL_MSG QCTLMsg, void *arg) {
+   QCTLMsg->GetVersionReq.TLVType       = QCTLV_TYPE_REQUIRED_PARAMETER;
+   QCTLMsg->GetVersionReq.TLVLength     = cpu_to_le16(0x0001);
+   QCTLMsg->GetVersionReq.QMUXTypes     = QMUX_TYPE_ALL;
+   return sizeof(QMICTL_GET_VERSION_REQ_MSG);
+}
+
+static USHORT CtlGetClientIdReq(PQMICTL_MSG QCTLMsg, void *arg) {
+   QCTLMsg->GetClientIdReq.TLVType       = QCTLV_TYPE_REQUIRED_PARAMETER;
+   QCTLMsg->GetClientIdReq.TLVLength     = cpu_to_le16(0x0001);
+   QCTLMsg->GetClientIdReq.QMIType     = ((UCHAR *)arg)[0];
+   return sizeof(QMICTL_GET_CLIENT_ID_REQ_MSG);
+}
+
+static USHORT CtlReleaseClientIdReq(PQMICTL_MSG QCTLMsg, void *arg) {
+   QCTLMsg->ReleaseClientIdReq.TLVType       = QCTLV_TYPE_REQUIRED_PARAMETER;
+   QCTLMsg->ReleaseClientIdReq.TLVLength     = cpu_to_le16(0x0002);
+   QCTLMsg->ReleaseClientIdReq.QMIType     = ((UCHAR *)arg)[0];
+   QCTLMsg->ReleaseClientIdReq.ClientId = ((UCHAR *)arg)[1] ;
+   return sizeof(QMICTL_RELEASE_CLIENT_ID_REQ_MSG);
+}
+
+int QmiWwanSendQMI(PQCQMIMSG pRequest) {
+    struct pollfd pollfds[]= {{cdc_wdm_fd, POLLOUT, 0}};
+    int ret;
+
+    if (cdc_wdm_fd == -1) {
+        dbg_time("%s cdc_wdm_fd = -1", __func__);
+        return -ENODEV;
+    }
+
+    if (pRequest->QMIHdr.QMIType == QMUX_TYPE_WDS_IPV6)
+        pRequest->QMIHdr.QMIType = QMUX_TYPE_WDS;
+
+    do {
+        ret = poll(pollfds, sizeof(pollfds)/sizeof(pollfds[0]), 5000);
+    } while ((ret < 0) && (errno == EINTR));
+
+    if (pollfds[0].revents & POLLOUT) {
+        ssize_t nwrites = le16_to_cpu(pRequest->QMIHdr.Length) + 1;
+        ret = write(cdc_wdm_fd, pRequest, nwrites);
+        if (ret == nwrites) {
+            ret = 0;
+        } else {
+            dbg_time("%s write=%d, errno: %d (%s)", __func__, ret, errno, strerror(errno));
+        }
+    } else {
+        dbg_time("%s poll=%d, revents = 0x%x, errno: %d (%s)", __func__, ret, pollfds[0].revents, errno, strerror(errno));
+    }
+
+    return ret;
+}
+
+static int QmiWwanGetClientID(UCHAR QMIType) {
+    PQCQMIMSG pResponse;
+
+    QmiThreadSendQMI(ComposeQCTLMsg(QMICTL_GET_CLIENT_ID_REQ, CtlGetClientIdReq, &QMIType), &pResponse);
+
+    if (pResponse) {
+        USHORT QMUXResult = cpu_to_le16(pResponse->CTLMsg.QMICTLMsgHdrRsp.QMUXResult);       // QMI_RESULT_SUCCESS
+        USHORT QMUXError = cpu_to_le16(pResponse->CTLMsg.QMICTLMsgHdrRsp.QMUXError);        // QMI_ERR_INVALID_ARG
+        //UCHAR QMIType = pResponse->CTLMsg.GetClientIdRsp.QMIType;
+        UCHAR ClientId = pResponse->CTLMsg.GetClientIdRsp.ClientId;
+
+        if (!QMUXResult && !QMUXError && (QMIType == pResponse->CTLMsg.GetClientIdRsp.QMIType)) {
+            switch (QMIType) {
+                case QMUX_TYPE_WDS: dbg_time("Get clientWDS = %d", ClientId); break;
+                case QMUX_TYPE_DMS: dbg_time("Get clientDMS = %d", ClientId); break;
+                case QMUX_TYPE_NAS: dbg_time("Get clientNAS = %d", ClientId); break;
+                case QMUX_TYPE_QOS: dbg_time("Get clientQOS = %d", ClientId); break;
+                case QMUX_TYPE_WMS: dbg_time("Get clientWMS = %d", ClientId); break;
+                case QMUX_TYPE_PDS: dbg_time("Get clientPDS = %d", ClientId); break;
+                case QMUX_TYPE_UIM: dbg_time("Get clientUIM = %d", ClientId); break;
+                case QMUX_TYPE_WDS_ADMIN: dbg_time("Get clientWDA = %d", ClientId);
+                break;
+                default: break;
+            }
+            return ClientId;
+        }
+    }
+    return 0;
+}
+
+static int QmiWwanReleaseClientID(QMI_SERVICE_TYPE QMIType, UCHAR ClientId) {
+    UCHAR argv[] = {QMIType, ClientId};
+    QmiThreadSendQMI(ComposeQCTLMsg(QMICTL_RELEASE_CLIENT_ID_REQ, CtlReleaseClientIdReq, argv), NULL);
+    return 0;
+}
+
+int QmiWwanInit(PROFILE_T *profile) {
+    unsigned i;
+    int ret;
+    PQCQMIMSG pResponse;
+
+    for (i = 0; i < 10; i++) {
+        ret = QmiThreadSendQMITimeout(ComposeQCTLMsg(QMICTL_SYNC_REQ, NULL, NULL), NULL, 1 * 1000);
+        if (!ret)
+            break;
+        sleep(1);
+    }
+    if (ret)
+        return ret;
+
+    QmiThreadSendQMI(ComposeQCTLMsg(QMICTL_GET_VERSION_REQ, CtlGetVersionReq, NULL), &pResponse);
+    if (pResponse) free(pResponse);
+    qmiclientId[QMUX_TYPE_WDS] = QmiWwanGetClientID(QMUX_TYPE_WDS);
+    if (profile->IsDualIPSupported)
+        qmiclientId[QMUX_TYPE_WDS_IPV6] = QmiWwanGetClientID(QMUX_TYPE_WDS);
+    qmiclientId[QMUX_TYPE_DMS] = QmiWwanGetClientID(QMUX_TYPE_DMS);
+    qmiclientId[QMUX_TYPE_NAS] = QmiWwanGetClientID(QMUX_TYPE_NAS);
+    qmiclientId[QMUX_TYPE_UIM] = QmiWwanGetClientID(QMUX_TYPE_UIM);
+    qmiclientId[QMUX_TYPE_WDS_ADMIN] = QmiWwanGetClientID(QMUX_TYPE_WDS_ADMIN);
+    return 0;
+}
+
+int QmiWwanDeInit(void) {
+    unsigned int i;
+    for (i = 0; i < sizeof(qmiclientId)/sizeof(qmiclientId[0]); i++)
+    {
+        if (qmiclientId[i] != 0)
+        {
+                QmiWwanReleaseClientID(i, qmiclientId[i]);
+                qmiclientId[i] = 0;
+        }
+    }
+
+    return 0;
+}
+
+void * QmiWwanThread(void *pData) {
+    const char *cdc_wdm = (const char *)pData;
+    cdc_wdm_fd = open(cdc_wdm, O_RDWR | O_NONBLOCK | O_NOCTTY);
+    if (cdc_wdm_fd == -1) {
+        dbg_time("%s Failed to open %s, errno: %d (%s)", __func__, cdc_wdm, errno, strerror(errno));
+        qmidevice_send_event_to_main(RIL_INDICATE_DEVICE_DISCONNECTED);
+        pthread_exit(NULL);
+        return NULL;
+    }
+    fcntl(cdc_wdm_fd, F_SETFD, FD_CLOEXEC) ;
+
+    dbg_time("cdc_wdm_fd = %d", cdc_wdm_fd);
+
+    qmidevice_send_event_to_main(RIL_INDICATE_DEVICE_CONNECTED);
+
+    while (1) {
+        struct pollfd pollfds[] = {{qmidevice_control_fd[1], POLLIN, 0}, {cdc_wdm_fd, POLLIN, 0}};
+        int ne, ret, nevents = sizeof(pollfds)/sizeof(pollfds[0]);
+
+        do {
+            ret = poll(pollfds, nevents, -1);
+         } while ((ret < 0) && (errno == EINTR));
+
+        if (ret <= 0) {
+            dbg_time("%s poll=%d, errno: %d (%s)", __func__, ret, errno, strerror(errno));
+            break;
+        }
+
+        for (ne = 0; ne < nevents; ne++) {
+            int fd = pollfds[ne].fd;
+            short revents = pollfds[ne].revents;
+
+            //dbg_time("{%d, %x, %x}", pollfds[ne].fd, pollfds[ne].events, pollfds[ne].revents);
+
+            if (revents & (POLLERR | POLLHUP | POLLNVAL)) {
+                dbg_time("%s poll err/hup/inval", __func__);
+                dbg_time("poll fd = %d, events = 0x%04x", fd, revents);
+                if (fd == cdc_wdm_fd) {
+                } else {
+                }
+                if (revents & (POLLHUP | POLLNVAL)) //EC20 bug, Can get POLLERR
+                    goto __QmiWwanThread_quit;
+            }
+
+            if ((revents & POLLIN) == 0)
+                continue;
+
+            if (fd == qmidevice_control_fd[1]) {
+                int triger_event;
+                if (read(fd, &triger_event, sizeof(triger_event)) == sizeof(triger_event)) {
+                    //DBG("triger_event = 0x%x", triger_event);
+                    switch (triger_event) {
+                        case RIL_REQUEST_QUIT:
+                            goto __QmiWwanThread_quit;
+                        break;
+                        case SIGTERM:
+                        case SIGHUP:
+                        case SIGINT:
+                            QmiThreadRecvQMI(NULL);
+                        break;
+                        default:
+                        break;
+                    }
+                }
+            }
+
+            if (fd == cdc_wdm_fd) {
+                ssize_t nreads;
+                UCHAR QMIBuf[512];
+                PQCQMIMSG pResponse = (PQCQMIMSG)QMIBuf;
+
+                nreads = read(fd, QMIBuf, sizeof(QMIBuf));
+                //dbg_time("%s read=%d errno: %d (%s)",  __func__, (int)nreads, errno, strerror(errno));
+                if (nreads <= 0) {
+                    dbg_time("%s read=%d errno: %d (%s)",  __func__, (int)nreads, errno, strerror(errno));
+                    break;
+                }
+
+                if (nreads != (le16_to_cpu(pResponse->QMIHdr.Length) + 1)) {
+                    dbg_time("%s nreads=%d,  pQCQMI->QMIHdr.Length = %d",  __func__, (int)nreads, le16_to_cpu(pResponse->QMIHdr.Length));
+                    continue;
+                }
+
+                QmiThreadRecvQMI(pResponse);
+            }
+        }
+    }
+
+__QmiWwanThread_quit:
+    if (cdc_wdm_fd != -1) { close(cdc_wdm_fd); cdc_wdm_fd = -1; }
+    qmidevice_send_event_to_main(RIL_INDICATE_DEVICE_DISCONNECTED);
+    QmiThreadRecvQMI(NULL); //main thread may pending on QmiThreadSendQMI()
+    dbg_time("%s exit", __func__);
+    pthread_exit(NULL);
+    return NULL;
+}
+
+#else
+int QmiWwanSendQMI(PQCQMIMSG pRequest) {return -1;}
+int QmiWwanInit(PROFILE_T *profile) {return -1;}
+int QmiWwanDeInit(void) {return -1;}
+void * QmiWwanThread(void *pData) {dbg_time("please set CONFIG_QMIWWAN"); return NULL;}
+#endif

root/package/link4all/quectel-CM/simcom-cm/default.script

@@ -0,0 +1,63 @@
+#!/bin/sh
+# Busybox udhcpc dispatcher script. Copyright (C) 2009 by Axel Beckert.
+#
+# Based on the busybox example scripts and the old udhcp source
+# package default.* scripts.
+
+RESOLV_CONF="/etc/resolv.conf"
+
+case $1 in
+    bound|renew)
+	[ -n "$broadcast" ] && BROADCAST="broadcast $broadcast"
+	[ -n "$subnet" ] && NETMASK="netmask $subnet"
+
+	/sbin/ifconfig $interface $ip $BROADCAST $NETMASK
+
+	if [ -n "$router" ]; then
+	    echo "$0: Resetting default routes"
+	    while /sbin/route del default gw 0.0.0.0 dev $interface; do :; done
+
+	    metric=0
+	    for i in $router; do
+		/sbin/route add default gw $i dev $interface metric $metric
+		metric=$(($metric + 1))
+	    done
+	fi
+
+	# Update resolver configuration file
+	R=""
+	[ -n "$domain" ] && R="domain $domain
+"
+	for i in $dns; do
+	    echo "$0: Adding DNS $i"
+	    R="${R}nameserver $i
+"
+	done
+
+	if [ ! -x /sbin/resolvconf ]; then
+	    echo -n "$R" | resolvconf -a "${interface}.udhcpc"
+	else
+	    echo -n "$R" > "$RESOLV_CONF"
+	fi
+	;;
+
+    deconfig)
+	if [ -x /sbin/resolvconf ]; then
+	    resolvconf -d "${interface}.udhcpc"
+	fi
+	/sbin/ifconfig $interface 0.0.0.0
+	;;
+
+    leasefail)
+	echo "$0: Lease failed: $message"
+	;;
+
+    nak)
+	echo "$0: Received a NAK: $message"
+	;;
+
+    *)
+	echo "$0: Unknown udhcpc command: $1";
+	exit 1;
+	;;
+esac