1 /******************************************************************************
2 @file MPQMUX.c
3 @brief QMI mux.
4
5 DESCRIPTION
6 Connectivity Management Tool for USB network adapter of Quectel wireless cellular modules.
7
8 INITIALIZATION AND SEQUENCING REQUIREMENTS
9 None.
10
11 ---------------------------------------------------------------------------
12 Copyright (c) 2016 - 2020 Quectel Wireless Solution, Co., Ltd. All Rights Reserved.
13 Quectel Wireless Solution Proprietary and Confidential.
14 ---------------------------------------------------------------------------
15 ******************************************************************************/
16
17 #include "QMIThread.h"
18 static char line[1024];
19 static pthread_mutex_t dumpQMIMutex = PTHREAD_MUTEX_INITIALIZER;
20 #undef dbg
21 #define dbg( format, arg... ) do {if (strlen(line) < sizeof(line)) snprintf(&line[strlen(line)], sizeof(line) - strlen(line), format, ## arg);} while (0)
22
23 PQMI_TLV_HDR GetTLV (PQCQMUX_MSG_HDR pQMUXMsgHdr, int TLVType);
24
25 typedef struct {
26 UINT type;
27 const char *name;
28 } QMI_NAME_T;
29
30 #define qmi_name_item(type) {type, #type}
31
32 #if 0
33 static const QMI_NAME_T qmi_IFType[] = {
34 {USB_CTL_MSG_TYPE_QMI, "USB_CTL_MSG_TYPE_QMI"},
35 };
36
37 static const QMI_NAME_T qmi_CtlFlags[] = {
38 qmi_name_item(QMICTL_CTL_FLAG_CMD),
39 qmi_name_item(QCQMI_CTL_FLAG_SERVICE),
40 };
41
42 static const QMI_NAME_T qmi_QMIType[] = {
43 qmi_name_item(QMUX_TYPE_CTL),
44 qmi_name_item(QMUX_TYPE_WDS),
45 qmi_name_item(QMUX_TYPE_DMS),
46 qmi_name_item(QMUX_TYPE_NAS),
47 qmi_name_item(QMUX_TYPE_QOS),
48 qmi_name_item(QMUX_TYPE_WMS),
49 qmi_name_item(QMUX_TYPE_PDS),
50 qmi_name_item(QMUX_TYPE_WDS_ADMIN),
51 };
52
53 static const QMI_NAME_T qmi_ctl_CtlFlags[] = {
54 qmi_name_item(QMICTL_FLAG_REQUEST),
55 qmi_name_item(QMICTL_FLAG_RESPONSE),
56 qmi_name_item(QMICTL_FLAG_INDICATION),
57 };
58 #endif
59
60 static const QMI_NAME_T qmux_ctl_QMICTLType[] = {
61 // QMICTL Type
62 qmi_name_item(QMICTL_SET_INSTANCE_ID_REQ), // 0x0020
63 qmi_name_item(QMICTL_SET_INSTANCE_ID_RESP), // 0x0020
64 qmi_name_item(QMICTL_GET_VERSION_REQ), // 0x0021
65 qmi_name_item(QMICTL_GET_VERSION_RESP), // 0x0021
66 qmi_name_item(QMICTL_GET_CLIENT_ID_REQ), // 0x0022
67 qmi_name_item(QMICTL_GET_CLIENT_ID_RESP), // 0x0022
68 qmi_name_item(QMICTL_RELEASE_CLIENT_ID_REQ), // 0x0023
69 qmi_name_item(QMICTL_RELEASE_CLIENT_ID_RESP), // 0x0023
70 qmi_name_item(QMICTL_REVOKE_CLIENT_ID_IND), // 0x0024
71 qmi_name_item(QMICTL_INVALID_CLIENT_ID_IND), // 0x0025
72 qmi_name_item(QMICTL_SET_DATA_FORMAT_REQ), // 0x0026
73 qmi_name_item(QMICTL_SET_DATA_FORMAT_RESP), // 0x0026
74 qmi_name_item(QMICTL_SYNC_REQ), // 0x0027
75 qmi_name_item(QMICTL_SYNC_RESP), // 0x0027
76 qmi_name_item(QMICTL_SYNC_IND), // 0x0027
77 };
78
79 static const QMI_NAME_T qmux_CtlFlags[] = {
80 qmi_name_item(QMUX_CTL_FLAG_TYPE_CMD),
81 qmi_name_item(QMUX_CTL_FLAG_TYPE_RSP),
82 qmi_name_item(QMUX_CTL_FLAG_TYPE_IND),
83 };
84
85
86 static const QMI_NAME_T qmux_wds_Type[] = {
87 qmi_name_item(QMIWDS_SET_EVENT_REPORT_REQ), // 0x0001
88 qmi_name_item(QMIWDS_SET_EVENT_REPORT_RESP), // 0x0001
89 qmi_name_item(QMIWDS_EVENT_REPORT_IND), // 0x0001
90 qmi_name_item(QMIWDS_START_NETWORK_INTERFACE_REQ), // 0x0020
91 qmi_name_item(QMIWDS_START_NETWORK_INTERFACE_RESP), // 0x0020
92 qmi_name_item(QMIWDS_STOP_NETWORK_INTERFACE_REQ), // 0x0021
93 qmi_name_item(QMIWDS_STOP_NETWORK_INTERFACE_RESP), // 0x0021
94 qmi_name_item(QMIWDS_GET_PKT_SRVC_STATUS_REQ), // 0x0022
95 qmi_name_item(QMIWDS_GET_PKT_SRVC_STATUS_RESP), // 0x0022
96 qmi_name_item(QMIWDS_GET_PKT_SRVC_STATUS_IND), // 0x0022
97 qmi_name_item(QMIWDS_GET_CURRENT_CHANNEL_RATE_REQ), // 0x0023
98 qmi_name_item(QMIWDS_GET_CURRENT_CHANNEL_RATE_RESP), // 0x0023
99 qmi_name_item(QMIWDS_GET_PKT_STATISTICS_REQ), // 0x0024
100 qmi_name_item(QMIWDS_GET_PKT_STATISTICS_RESP), // 0x0024
101 qmi_name_item(QMIWDS_MODIFY_PROFILE_SETTINGS_REQ), // 0x0028
102 qmi_name_item(QMIWDS_MODIFY_PROFILE_SETTINGS_RESP), // 0x0028
103 qmi_name_item(QMIWDS_GET_PROFILE_SETTINGS_REQ), // 0x002B
104 qmi_name_item(QMIWDS_GET_PROFILE_SETTINGS_RESP), // 0x002BD
105 qmi_name_item(QMIWDS_GET_DEFAULT_SETTINGS_REQ), // 0x002C
106 qmi_name_item(QMIWDS_GET_DEFAULT_SETTINGS_RESP), // 0x002C
107 qmi_name_item(QMIWDS_GET_RUNTIME_SETTINGS_REQ), // 0x002D
108 qmi_name_item(QMIWDS_GET_RUNTIME_SETTINGS_RESP), // 0x002D
109 qmi_name_item(QMIWDS_GET_MIP_MODE_REQ), // 0x002F
110 qmi_name_item(QMIWDS_GET_MIP_MODE_RESP), // 0x002F
111 qmi_name_item(QMIWDS_GET_DATA_BEARER_REQ), // 0x0037
112 qmi_name_item(QMIWDS_GET_DATA_BEARER_RESP), // 0x0037
113 qmi_name_item(QMIWDS_DUN_CALL_INFO_REQ), // 0x0038
114 qmi_name_item(QMIWDS_DUN_CALL_INFO_RESP), // 0x0038
115 qmi_name_item(QMIWDS_DUN_CALL_INFO_IND), // 0x0038
116 qmi_name_item(QMIWDS_SET_CLIENT_IP_FAMILY_PREF_REQ), // 0x004D
117 qmi_name_item(QMIWDS_SET_CLIENT_IP_FAMILY_PREF_RESP), // 0x004D
118 qmi_name_item(QMIWDS_SET_AUTO_CONNECT_REQ), // 0x0051
119 qmi_name_item(QMIWDS_SET_AUTO_CONNECT_RESP), // 0x0051
120 qmi_name_item(QMIWDS_BIND_MUX_DATA_PORT_REQ), // 0x00A2
121 qmi_name_item(QMIWDS_BIND_MUX_DATA_PORT_RESP), // 0x00A2
122 };
123
124 static const QMI_NAME_T qmux_dms_Type[] = {
125 // ======================= DMS ==============================
126 qmi_name_item(QMIDMS_SET_EVENT_REPORT_REQ), // 0x0001
127 qmi_name_item(QMIDMS_SET_EVENT_REPORT_RESP), // 0x0001
128 qmi_name_item(QMIDMS_EVENT_REPORT_IND), // 0x0001
129 qmi_name_item(QMIDMS_GET_DEVICE_CAP_REQ), // 0x0020
130 qmi_name_item(QMIDMS_GET_DEVICE_CAP_RESP), // 0x0020
131 qmi_name_item(QMIDMS_GET_DEVICE_MFR_REQ), // 0x0021
132 qmi_name_item(QMIDMS_GET_DEVICE_MFR_RESP), // 0x0021
133 qmi_name_item(QMIDMS_GET_DEVICE_MODEL_ID_REQ), // 0x0022
134 qmi_name_item(QMIDMS_GET_DEVICE_MODEL_ID_RESP), // 0x0022
135 qmi_name_item(QMIDMS_GET_DEVICE_REV_ID_REQ), // 0x0023
136 qmi_name_item(QMIDMS_GET_DEVICE_REV_ID_RESP), // 0x0023
137 qmi_name_item(QMIDMS_GET_MSISDN_REQ), // 0x0024
138 qmi_name_item(QMIDMS_GET_MSISDN_RESP), // 0x0024
139 qmi_name_item(QMIDMS_GET_DEVICE_SERIAL_NUMBERS_REQ), // 0x0025
140 qmi_name_item(QMIDMS_GET_DEVICE_SERIAL_NUMBERS_RESP), // 0x0025
141 qmi_name_item(QMIDMS_UIM_SET_PIN_PROTECTION_REQ), // 0x0027
142 qmi_name_item(QMIDMS_UIM_SET_PIN_PROTECTION_RESP), // 0x0027
143 qmi_name_item(QMIDMS_UIM_VERIFY_PIN_REQ), // 0x0028
144 qmi_name_item(QMIDMS_UIM_VERIFY_PIN_RESP), // 0x0028
145 qmi_name_item(QMIDMS_UIM_UNBLOCK_PIN_REQ), // 0x0029
146 qmi_name_item(QMIDMS_UIM_UNBLOCK_PIN_RESP), // 0x0029
147 qmi_name_item(QMIDMS_UIM_CHANGE_PIN_REQ), // 0x002A
148 qmi_name_item(QMIDMS_UIM_CHANGE_PIN_RESP), // 0x002A
149 qmi_name_item(QMIDMS_UIM_GET_PIN_STATUS_REQ), // 0x002B
150 qmi_name_item(QMIDMS_UIM_GET_PIN_STATUS_RESP), // 0x002B
151 qmi_name_item(QMIDMS_GET_DEVICE_HARDWARE_REV_REQ), // 0x002C
152 qmi_name_item(QMIDMS_GET_DEVICE_HARDWARE_REV_RESP), // 0x002C
153 qmi_name_item(QMIDMS_GET_OPERATING_MODE_REQ), // 0x002D
154 qmi_name_item(QMIDMS_GET_OPERATING_MODE_RESP), // 0x002D
155 qmi_name_item(QMIDMS_SET_OPERATING_MODE_REQ), // 0x002E
156 qmi_name_item(QMIDMS_SET_OPERATING_MODE_RESP), // 0x002E
157 qmi_name_item(QMIDMS_GET_ACTIVATED_STATUS_REQ), // 0x0031
158 qmi_name_item(QMIDMS_GET_ACTIVATED_STATUS_RESP), // 0x0031
159 qmi_name_item(QMIDMS_ACTIVATE_AUTOMATIC_REQ), // 0x0032
160 qmi_name_item(QMIDMS_ACTIVATE_AUTOMATIC_RESP), // 0x0032
161 qmi_name_item(QMIDMS_ACTIVATE_MANUAL_REQ), // 0x0033
162 qmi_name_item(QMIDMS_ACTIVATE_MANUAL_RESP), // 0x0033
163 qmi_name_item(QMIDMS_UIM_GET_ICCID_REQ), // 0x003C
164 qmi_name_item(QMIDMS_UIM_GET_ICCID_RESP), // 0x003C
165 qmi_name_item(QMIDMS_UIM_GET_CK_STATUS_REQ), // 0x0040
166 qmi_name_item(QMIDMS_UIM_GET_CK_STATUS_RESP), // 0x0040
167 qmi_name_item(QMIDMS_UIM_SET_CK_PROTECTION_REQ), // 0x0041
168 qmi_name_item(QMIDMS_UIM_SET_CK_PROTECTION_RESP), // 0x0041
169 qmi_name_item(QMIDMS_UIM_UNBLOCK_CK_REQ), // 0x0042
170 qmi_name_item(QMIDMS_UIM_UNBLOCK_CK_RESP), // 0x0042
171 qmi_name_item(QMIDMS_UIM_GET_IMSI_REQ), // 0x0043
172 qmi_name_item(QMIDMS_UIM_GET_IMSI_RESP), // 0x0043
173 qmi_name_item(QMIDMS_UIM_GET_STATE_REQ), // 0x0044
174 qmi_name_item(QMIDMS_UIM_GET_STATE_RESP), // 0x0044
175 qmi_name_item(QMIDMS_GET_BAND_CAP_REQ), // 0x0045
176 qmi_name_item(QMIDMS_GET_BAND_CAP_RESP), // 0x0045
177 };
178
179 static const QMI_NAME_T qmux_nas_Type[] = {
180 // ======================= NAS ==============================
181 qmi_name_item(QMINAS_SET_EVENT_REPORT_REQ), // 0x0002
182 qmi_name_item(QMINAS_SET_EVENT_REPORT_RESP), // 0x0002
183 qmi_name_item(QMINAS_EVENT_REPORT_IND), // 0x0002
184 qmi_name_item(QMINAS_GET_SIGNAL_STRENGTH_REQ), // 0x0020
185 qmi_name_item(QMINAS_GET_SIGNAL_STRENGTH_RESP), // 0x0020
186 qmi_name_item(QMINAS_PERFORM_NETWORK_SCAN_REQ), // 0x0021
187 qmi_name_item(QMINAS_PERFORM_NETWORK_SCAN_RESP), // 0x0021
188 qmi_name_item(QMINAS_INITIATE_NW_REGISTER_REQ), // 0x0022
189 qmi_name_item(QMINAS_INITIATE_NW_REGISTER_RESP), // 0x0022
190 qmi_name_item(QMINAS_INITIATE_ATTACH_REQ), // 0x0023
191 qmi_name_item(QMINAS_INITIATE_ATTACH_RESP), // 0x0023
192 qmi_name_item(QMINAS_GET_SERVING_SYSTEM_REQ), // 0x0024
193 qmi_name_item(QMINAS_GET_SERVING_SYSTEM_RESP), // 0x0024
194 qmi_name_item(QMINAS_SERVING_SYSTEM_IND), // 0x0024
195 qmi_name_item(QMINAS_GET_HOME_NETWORK_REQ), // 0x0025
196 qmi_name_item(QMINAS_GET_HOME_NETWORK_RESP), // 0x0025
197 qmi_name_item(QMINAS_GET_PREFERRED_NETWORK_REQ), // 0x0026
198 qmi_name_item(QMINAS_GET_PREFERRED_NETWORK_RESP), // 0x0026
199 qmi_name_item(QMINAS_SET_PREFERRED_NETWORK_REQ), // 0x0027
200 qmi_name_item(QMINAS_SET_PREFERRED_NETWORK_RESP), // 0x0027
201 qmi_name_item(QMINAS_GET_FORBIDDEN_NETWORK_REQ), // 0x0028
202 qmi_name_item(QMINAS_GET_FORBIDDEN_NETWORK_RESP), // 0x0028
203 qmi_name_item(QMINAS_SET_FORBIDDEN_NETWORK_REQ), // 0x0029
204 qmi_name_item(QMINAS_SET_FORBIDDEN_NETWORK_RESP), // 0x0029
205 qmi_name_item(QMINAS_SET_TECHNOLOGY_PREF_REQ), // 0x002A
206 qmi_name_item(QMINAS_SET_TECHNOLOGY_PREF_RESP), // 0x002A
207 qmi_name_item(QMINAS_GET_RF_BAND_INFO_REQ), // 0x0031
208 qmi_name_item(QMINAS_GET_RF_BAND_INFO_RESP), // 0x0031
209 qmi_name_item(QMINAS_GET_PLMN_NAME_REQ), // 0x0044
210 qmi_name_item(QMINAS_GET_PLMN_NAME_RESP), // 0x0044
211 qmi_name_item(QUECTEL_PACKET_TRANSFER_START_IND), // 0X100
212 qmi_name_item(QUECTEL_PACKET_TRANSFER_END_IND), // 0X101
213 qmi_name_item(QMINAS_GET_SYS_INFO_REQ), // 0x004D
214 qmi_name_item(QMINAS_GET_SYS_INFO_RESP), // 0x004D
215 qmi_name_item(QMINAS_SYS_INFO_IND), // 0x004D
216 };
217
218 static const QMI_NAME_T qmux_wms_Type[] = {
219 // ======================= WMS ==============================
220 qmi_name_item(QMIWMS_SET_EVENT_REPORT_REQ), // 0x0001
221 qmi_name_item(QMIWMS_SET_EVENT_REPORT_RESP), // 0x0001
222 qmi_name_item(QMIWMS_EVENT_REPORT_IND), // 0x0001
223 qmi_name_item(QMIWMS_RAW_SEND_REQ), // 0x0020
224 qmi_name_item(QMIWMS_RAW_SEND_RESP), // 0x0020
225 qmi_name_item(QMIWMS_RAW_WRITE_REQ), // 0x0021
226 qmi_name_item(QMIWMS_RAW_WRITE_RESP), // 0x0021
227 qmi_name_item(QMIWMS_RAW_READ_REQ), // 0x0022
228 qmi_name_item(QMIWMS_RAW_READ_RESP), // 0x0022
229 qmi_name_item(QMIWMS_MODIFY_TAG_REQ), // 0x0023
230 qmi_name_item(QMIWMS_MODIFY_TAG_RESP), // 0x0023
231 qmi_name_item(QMIWMS_DELETE_REQ), // 0x0024
232 qmi_name_item(QMIWMS_DELETE_RESP), // 0x0024
233 qmi_name_item(QMIWMS_GET_MESSAGE_PROTOCOL_REQ), // 0x0030
234 qmi_name_item(QMIWMS_GET_MESSAGE_PROTOCOL_RESP), // 0x0030
235 qmi_name_item(QMIWMS_LIST_MESSAGES_REQ), // 0x0031
236 qmi_name_item(QMIWMS_LIST_MESSAGES_RESP), // 0x0031
237 qmi_name_item(QMIWMS_GET_SMSC_ADDRESS_REQ), // 0x0034
238 qmi_name_item(QMIWMS_GET_SMSC_ADDRESS_RESP), // 0x0034
239 qmi_name_item(QMIWMS_SET_SMSC_ADDRESS_REQ), // 0x0035
240 qmi_name_item(QMIWMS_SET_SMSC_ADDRESS_RESP), // 0x0035
241 qmi_name_item(QMIWMS_GET_STORE_MAX_SIZE_REQ), // 0x0036
242 qmi_name_item(QMIWMS_GET_STORE_MAX_SIZE_RESP), // 0x0036
243 };
244
245 static const QMI_NAME_T qmux_wds_admin_Type[] = {
246 qmi_name_item(QMIWDS_ADMIN_SET_DATA_FORMAT_REQ), // 0x0020
247 qmi_name_item(QMIWDS_ADMIN_SET_DATA_FORMAT_RESP), // 0x0020
248 qmi_name_item(QMIWDS_ADMIN_GET_DATA_FORMAT_REQ), // 0x0021
249 qmi_name_item(QMIWDS_ADMIN_GET_DATA_FORMAT_RESP), // 0x0021
250 qmi_name_item(QMIWDS_ADMIN_SET_QMAP_SETTINGS_REQ), // 0x002B
251 qmi_name_item(QMIWDS_ADMIN_SET_QMAP_SETTINGS_RESP), // 0x002B
252 qmi_name_item(QMIWDS_ADMIN_GET_QMAP_SETTINGS_REQ), // 0x002C
253 qmi_name_item(QMIWDS_ADMIN_GET_QMAP_SETTINGS_RESP), // 0x002C
254 qmi_name_item(QMI_WDA_SET_LOOPBACK_CONFIG_REQ), // 0x002F
255 qmi_name_item(QMI_WDA_SET_LOOPBACK_CONFIG_RESP), // 0x002F
256 qmi_name_item(QMI_WDA_SET_LOOPBACK_CONFIG_IND), // 0x002F
257 };
258
259 static const QMI_NAME_T qmux_uim_Type[] = {
260 qmi_name_item( QMIUIM_READ_TRANSPARENT_REQ), // 0x0020
261 qmi_name_item( QMIUIM_READ_TRANSPARENT_RESP), // 0x0020
262 qmi_name_item( QMIUIM_READ_TRANSPARENT_IND), // 0x0020
263 qmi_name_item( QMIUIM_READ_RECORD_REQ), // 0x0021
264 qmi_name_item( QMIUIM_READ_RECORD_RESP), // 0x0021
265 qmi_name_item( QMIUIM_READ_RECORD_IND), // 0x0021
266 qmi_name_item( QMIUIM_WRITE_TRANSPARENT_REQ), // 0x0022
267 qmi_name_item( QMIUIM_WRITE_TRANSPARENT_RESP), // 0x0022
268 qmi_name_item( QMIUIM_WRITE_TRANSPARENT_IND), // 0x0022
269 qmi_name_item( QMIUIM_WRITE_RECORD_REQ), // 0x0023
270 qmi_name_item( QMIUIM_WRITE_RECORD_RESP), // 0x0023
271 qmi_name_item( QMIUIM_WRITE_RECORD_IND), // 0x0023
272 qmi_name_item( QMIUIM_SET_PIN_PROTECTION_REQ), // 0x0025
273 qmi_name_item( QMIUIM_SET_PIN_PROTECTION_RESP), // 0x0025
274 qmi_name_item( QMIUIM_SET_PIN_PROTECTION_IND), // 0x0025
275 qmi_name_item( QMIUIM_VERIFY_PIN_REQ), // 0x0026
276 qmi_name_item( QMIUIM_VERIFY_PIN_RESP), // 0x0026
277 qmi_name_item( QMIUIM_VERIFY_PIN_IND), // 0x0026
278 qmi_name_item( QMIUIM_UNBLOCK_PIN_REQ), // 0x0027
279 qmi_name_item( QMIUIM_UNBLOCK_PIN_RESP), // 0x0027
280 qmi_name_item( QMIUIM_UNBLOCK_PIN_IND), // 0x0027
281 qmi_name_item( QMIUIM_CHANGE_PIN_REQ), // 0x0028
282 qmi_name_item( QMIUIM_CHANGE_PIN_RESP), // 0x0028
283 qmi_name_item( QMIUIM_CHANGE_PIN_IND), // 0x0028
284 qmi_name_item( QMIUIM_DEPERSONALIZATION_REQ), // 0x0029
285 qmi_name_item( QMIUIM_DEPERSONALIZATION_RESP), // 0x0029
286 qmi_name_item( QMIUIM_EVENT_REG_REQ), // 0x002E
287 qmi_name_item( QMIUIM_EVENT_REG_RESP), // 0x002E
288 qmi_name_item( QMIUIM_GET_CARD_STATUS_REQ), // 0x002F
289 qmi_name_item( QMIUIM_GET_CARD_STATUS_RESP), // 0x002F
290 qmi_name_item( QMIUIM_STATUS_CHANGE_IND), // 0x0032
291 };
292
qmi_name_get(const QMI_NAME_T * table,size_t size,int type,const char * tag)293 static const char * qmi_name_get(const QMI_NAME_T *table, size_t size, int type, const char *tag) {
294 static char unknow[40];
295 size_t i;
296
297 if (qmux_CtlFlags == table) {
298 if (!strcmp(tag, "_REQ"))
299 tag = "_CMD";
300 else if (!strcmp(tag, "_RESP"))
301 tag = "_RSP";
302 }
303
304 for (i = 0; i < size; i++) {
305 if (table[i].type == (UINT)type) {
306 if (!tag || (strstr(table[i].name, tag)))
307 return table[i].name;
308 }
309 }
310 sprintf(unknow, "unknow_%x", type);
311 return unknow;
312 }
313
314 #define QMI_NAME(table, type) qmi_name_get(table, sizeof(table) / sizeof(table[0]), type, 0)
315 #define QMUX_NAME(table, type, tag) qmi_name_get(table, sizeof(table) / sizeof(table[0]), type, tag)
316
dump_tlv(PQCQMUX_MSG_HDR pQMUXMsgHdr)317 void dump_tlv(PQCQMUX_MSG_HDR pQMUXMsgHdr) {
318 int TLVFind = 0;
319 int i;
320 //dbg("QCQMUX_TLV-----------------------------------\n");
321 //dbg("{Type,\tLength,\tValue}\n");
322
323 while (1) {
324 PQMI_TLV_HDR TLVHdr = GetTLV(pQMUXMsgHdr, 0x1000 + (++TLVFind));
325 if (TLVHdr == NULL)
326 break;
327
328 //if ((TLVHdr->TLVType == 0x02) && ((USHORT *)(TLVHdr+1))[0])
329 {
330 dbg("{%02x,\t%04x,\t", TLVHdr->TLVType, le16_to_cpu(TLVHdr->TLVLength));
331 for (i = 0; i < le16_to_cpu(TLVHdr->TLVLength); i++) {
332 dbg("%02x ", ((UCHAR *)(TLVHdr+1))[i]);
333 }
334 dbg("}\n");
335 }
336 } // while
337 }
338
dump_ctl(PQCQMICTL_MSG_HDR CTLHdr)339 void dump_ctl(PQCQMICTL_MSG_HDR CTLHdr) {
340 const char *tag;
341
342 //dbg("QCQMICTL_MSG--------------------------------------------\n");
343 //dbg("CtlFlags: %02x\t\t%s\n", CTLHdr->CtlFlags, QMI_NAME(qmi_ctl_CtlFlags, CTLHdr->CtlFlags));
344 dbg("TransactionId: %02x\n", CTLHdr->TransactionId);
345 switch (CTLHdr->CtlFlags) {
346 case QMICTL_FLAG_REQUEST: tag = "_REQ"; break;
347 case QMICTL_FLAG_RESPONSE: tag = "_RESP"; break;
348 case QMICTL_FLAG_INDICATION: tag = "_IND"; break;
349 default: tag = 0; break;
350 }
351 dbg("QMICTLType: %04x\t%s\n", le16_to_cpu(CTLHdr->QMICTLType),
352 QMUX_NAME(qmux_ctl_QMICTLType, le16_to_cpu(CTLHdr->QMICTLType), tag));
353 dbg("Length: %04x\n", le16_to_cpu(CTLHdr->Length));
354
355 dump_tlv((PQCQMUX_MSG_HDR)(&CTLHdr->QMICTLType));
356 }
357
dump_qmux(QMI_SERVICE_TYPE serviceType,PQCQMUX_HDR QMUXHdr)358 int dump_qmux(QMI_SERVICE_TYPE serviceType, PQCQMUX_HDR QMUXHdr) {
359 PQCQMUX_MSG_HDR QMUXMsgHdr = (PQCQMUX_MSG_HDR) (QMUXHdr + 1);
360 CHAR *tag;
361
362 //dbg("QCQMUX--------------------------------------------\n");
363 switch (QMUXHdr->CtlFlags&QMUX_CTL_FLAG_MASK_TYPE) {
364 case QMUX_CTL_FLAG_TYPE_CMD: tag = "_REQ"; break;
365 case QMUX_CTL_FLAG_TYPE_RSP: tag = "_RESP"; break;
366 case QMUX_CTL_FLAG_TYPE_IND: tag = "_IND"; break;
367 default: tag = 0; break;
368 }
369 //dbg("CtlFlags: %02x\t\t%s\n", QMUXHdr->CtlFlags, QMUX_NAME(qmux_CtlFlags, QMUXHdr->CtlFlags, tag));
370 dbg("TransactionId: %04x\n", le16_to_cpu(QMUXHdr->TransactionId));
371
372 //dbg("QCQMUX_MSG_HDR-----------------------------------\n");
373 switch (serviceType) {
374 case QMUX_TYPE_DMS:
375 dbg("Type: %04x\t%s\n", le16_to_cpu(QMUXMsgHdr->Type),
376 QMUX_NAME(qmux_dms_Type, le16_to_cpu(QMUXMsgHdr->Type), tag));
377 break;
378 case QMUX_TYPE_NAS:
379 dbg("Type: %04x\t%s\n", le16_to_cpu(QMUXMsgHdr->Type),
380 QMUX_NAME(qmux_nas_Type, le16_to_cpu(QMUXMsgHdr->Type), tag));
381 break;
382 case QMUX_TYPE_WDS:
383 case QMUX_TYPE_WDS_IPV6:
384 dbg("Type: %04x\t%s\n", le16_to_cpu(QMUXMsgHdr->Type),
385 QMUX_NAME(qmux_wds_Type, le16_to_cpu(QMUXMsgHdr->Type), tag));
386 break;
387 case QMUX_TYPE_WMS:
388 dbg("Type: %04x\t%s\n", le16_to_cpu(QMUXMsgHdr->Type),
389 QMUX_NAME(qmux_wms_Type, le16_to_cpu(QMUXMsgHdr->Type), tag));
390 break;
391 case QMUX_TYPE_WDS_ADMIN:
392 dbg("Type: %04x\t%s\n", le16_to_cpu(QMUXMsgHdr->Type),
393 QMUX_NAME(qmux_wds_admin_Type, le16_to_cpu(QMUXMsgHdr->Type), tag));
394 break;
395 case QMUX_TYPE_UIM:
396 dbg("Type: %04x\t%s\n", le16_to_cpu(QMUXMsgHdr->Type),
397 QMUX_NAME(qmux_uim_Type, le16_to_cpu(QMUXMsgHdr->Type), tag));
398 break;
399 case QMUX_TYPE_PDS:
400 case QMUX_TYPE_QOS:
401 case QMUX_TYPE_CTL:
402 default:
403 dbg("Type: %04x\t%s\n", le16_to_cpu(QMUXMsgHdr->Type), "PDS/QOS/CTL/unknown!");
404 break;
405 }
406 dbg("Length: %04x\n", le16_to_cpu(QMUXMsgHdr->Length));
407
408 dump_tlv(QMUXMsgHdr);
409
410 return 0;
411 }
412
dump_qmi(void * dataBuffer,int dataLen)413 void dump_qmi(void *dataBuffer, int dataLen)
414 {
415 PQCQMI_HDR QMIHdr = (PQCQMI_HDR)dataBuffer;
416 PQCQMUX_HDR QMUXHdr = (PQCQMUX_HDR) (QMIHdr + 1);
417 PQCQMICTL_MSG_HDR CTLHdr = (PQCQMICTL_MSG_HDR) (QMIHdr + 1);
418
419 int i;
420
421 if (!debug_qmi)
422 return;
423
424 pthread_mutex_lock(&dumpQMIMutex);
425 line[0] = 0;
426 for (i = 0; i < dataLen; i++) {
427 dbg("%02x ", ((unsigned char *)dataBuffer)[i]);
428 }
429 dbg_time("%s", line);
430 line[0] = 0;
431
432 //dbg("QCQMI_HDR-----------------------------------------");
433 //dbg("IFType: %02x\t\t%s", QMIHdr->IFType, QMI_NAME(qmi_IFType, QMIHdr->IFType));
434 //dbg("Length: %04x", le16_to_cpu(QMIHdr->Length));
435 //dbg("CtlFlags: %02x\t\t%s", QMIHdr->CtlFlags, QMI_NAME(qmi_CtlFlags, QMIHdr->CtlFlags));
436 //dbg("QMIType: %02x\t\t%s", QMIHdr->QMIType, QMI_NAME(qmi_QMIType, QMIHdr->QMIType));
437 //dbg("ClientId: %02x", QMIHdr->ClientId);
438
439 if (QMIHdr->QMIType == QMUX_TYPE_CTL) {
440 dump_ctl(CTLHdr);
441 } else {
442 dump_qmux(QMIHdr->QMIType, QMUXHdr);
443 }
444 dbg_time("%s", line);
445 pthread_mutex_unlock(&dumpQMIMutex);
446 }
447