2 * uqmi -- tiny QMI support implementation
4 * Copyright (C) 2014-2015 Felix Fietkau <nbd@openwrt.org>
6 * This library is free software; you can redistribute it and/or
7 * modify it under the terms of the GNU Lesser General Public
8 * License as published by the Free Software Foundation; either
9 * version 2 of the License, or (at your option) any later version.
11 * This library is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
14 * Lesser General Public License for more details.
16 * You should have received a copy of the GNU Lesser General Public
17 * License along with this library; if not, write to the
18 * Free Software Foundation, Inc., 51 Franklin Street, Fifth Floor,
19 * Boston, MA 02110-1301 USA.
23 #include <arpa/inet.h>
25 #include "qmi-message.h"
27 static struct qmi_wds_start_network_request wds_sn_req
= {
28 QMI_INIT(authentication_preference
,
29 QMI_WDS_AUTHENTICATION_PAP
| QMI_WDS_AUTHENTICATION_CHAP
),
31 static struct qmi_wds_stop_network_request wds_stn_req
;
33 #define cmd_wds_set_apn_cb no_cb
34 static enum qmi_cmd_result
35 cmd_wds_set_apn_prepare(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
, char *arg
)
37 qmi_set_ptr(&wds_sn_req
, apn
, arg
);
41 #define cmd_wds_set_auth_cb no_cb
42 static enum qmi_cmd_result
43 cmd_wds_set_auth_prepare(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
, char *arg
)
47 QmiWdsAuthentication auth
;
49 { "pap", QMI_WDS_AUTHENTICATION_PAP
},
50 { "chap", QMI_WDS_AUTHENTICATION_CHAP
},
51 { "both", QMI_WDS_AUTHENTICATION_PAP
| QMI_WDS_AUTHENTICATION_CHAP
},
52 { "none", QMI_WDS_AUTHENTICATION_NONE
},
56 for (i
= 0; i
< ARRAY_SIZE(modes
); i
++) {
57 if (strcasecmp(modes
[i
].name
, arg
) != 0)
60 qmi_set(&wds_sn_req
, authentication_preference
, modes
[i
].auth
);
64 uqmi_add_error("Invalid auth mode (valid: pap, chap, both, none)");
68 #define cmd_wds_set_username_cb no_cb
69 static enum qmi_cmd_result
70 cmd_wds_set_username_prepare(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
, char *arg
)
72 qmi_set_ptr(&wds_sn_req
, username
, arg
);
76 #define cmd_wds_set_password_cb no_cb
77 static enum qmi_cmd_result
78 cmd_wds_set_password_prepare(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
, char *arg
)
80 qmi_set_ptr(&wds_sn_req
, password
, arg
);
84 #define cmd_wds_set_autoconnect_cb no_cb
85 static enum qmi_cmd_result
86 cmd_wds_set_autoconnect_prepare(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
, char *arg
)
88 qmi_set(&wds_sn_req
, enable_autoconnect
, true);
89 qmi_set(&wds_stn_req
, disable_autoconnect
, true);
93 #define cmd_wds_set_ip_family_pref_cb no_cb
94 static enum qmi_cmd_result
95 cmd_wds_set_ip_family_pref_prepare(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
, char *arg
)
99 const QmiWdsIpFamily mode
;
101 { "ipv4", QMI_WDS_IP_FAMILY_IPV4
},
102 { "ipv6", QMI_WDS_IP_FAMILY_IPV6
},
103 { "unspecified", QMI_WDS_IP_FAMILY_UNSPECIFIED
},
107 for (i
= 0; i
< ARRAY_SIZE(modes
); i
++) {
108 if (strcasecmp(modes
[i
].name
, arg
) != 0)
111 qmi_set(&wds_sn_req
, ip_family_preference
, modes
[i
].mode
);
115 uqmi_add_error("Invalid value (valid: ipv4, ipv6, unspecified)");
120 cmd_wds_start_network_cb(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
)
122 struct qmi_wds_start_network_response res
;
124 qmi_parse_wds_start_network_response(msg
, &res
);
125 if (res
.set
.packet_data_handle
)
126 blobmsg_add_u32(&status
, NULL
, res
.data
.packet_data_handle
);
129 static enum qmi_cmd_result
130 cmd_wds_start_network_prepare(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
, char *arg
)
132 qmi_set_wds_start_network_request(msg
, &wds_sn_req
);
133 return QMI_CMD_REQUEST
;
136 #define cmd_wds_stop_network_cb no_cb
137 static enum qmi_cmd_result
138 cmd_wds_stop_network_prepare(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
, char *arg
)
140 uint32_t pdh
= strtoul(arg
, NULL
, 0);
142 qmi_set(&wds_stn_req
, packet_data_handle
, pdh
);
143 qmi_set_wds_stop_network_request(msg
, &wds_stn_req
);
144 return QMI_CMD_REQUEST
;
148 cmd_wds_get_packet_service_status_cb(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
)
150 struct qmi_wds_get_packet_service_status_response res
;
151 const char *data_status
[] = {
152 [QMI_WDS_CONNECTION_STATUS_UNKNOWN
] = "unknown",
153 [QMI_WDS_CONNECTION_STATUS_DISCONNECTED
] = "disconnected",
154 [QMI_WDS_CONNECTION_STATUS_CONNECTED
] = "connected",
155 [QMI_WDS_CONNECTION_STATUS_SUSPENDED
] = "suspended",
156 [QMI_WDS_CONNECTION_STATUS_AUTHENTICATING
] = "authenticating",
160 qmi_parse_wds_get_packet_service_status_response(msg
, &res
);
161 if (res
.set
.connection_status
&&
162 res
.data
.connection_status
< ARRAY_SIZE(data_status
))
163 s
= res
.data
.connection_status
;
165 blobmsg_add_string(&status
, NULL
, data_status
[s
]);
168 static enum qmi_cmd_result
169 cmd_wds_get_packet_service_status_prepare(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
, char *arg
)
171 qmi_set_wds_get_packet_service_status_request(msg
);
172 return QMI_CMD_REQUEST
;
175 #define cmd_wds_set_autoconnect_setting_cb no_cb
176 static enum qmi_cmd_result
177 cmd_wds_set_autoconnect_setting_prepare(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
, char *arg
)
179 struct qmi_wds_set_autoconnect_setting_request ac_req
;
180 const char *modes
[] = {
181 [QMI_WDS_AUTOCONNECT_DISABLED
] = "disabled",
182 [QMI_WDS_AUTOCONNECT_ENABLED
] = "enabled",
183 [QMI_WDS_AUTOCONNECT_PAUSED
] = "paused",
187 for (i
= 0; i
< ARRAY_SIZE(modes
); i
++) {
188 if (strcasecmp(modes
[i
], arg
) != 0)
191 qmi_set(&ac_req
, setting
, i
);
192 qmi_set_wds_set_autoconnect_setting_request(msg
, &ac_req
);
196 uqmi_add_error("Invalid value (valid: disabled, enabled, paused)");
200 #define cmd_wds_reset_cb no_cb
201 static enum qmi_cmd_result
202 cmd_wds_reset_prepare(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
, char *arg
)
204 qmi_set_wds_reset_request(msg
);
205 return QMI_CMD_REQUEST
;
208 #define cmd_wds_set_ip_family_cb no_cb
209 static enum qmi_cmd_result
210 cmd_wds_set_ip_family_prepare(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
, char *arg
)
212 struct qmi_wds_set_ip_family_request ipf_req
;
213 const struct ip_modes
{
215 const QmiWdsIpFamily mode
;
217 { "ipv4", QMI_WDS_IP_FAMILY_IPV4
},
218 { "ipv6", QMI_WDS_IP_FAMILY_IPV6
},
219 { "unspecified", QMI_WDS_IP_FAMILY_UNSPECIFIED
},
223 for (i
= 0; i
< ARRAY_SIZE(modes
); i
++) {
224 if (strcasecmp(modes
[i
].name
, arg
) != 0)
227 qmi_set(&ipf_req
, preference
, modes
[i
].mode
);
228 qmi_set_wds_set_ip_family_request(msg
, &ipf_req
);
229 return QMI_CMD_REQUEST
;
232 uqmi_add_error("Invalid value (valid: ipv4, ipv6, unspecified)");
236 static void wds_to_ipv4(const char *name
, const uint32_t addr
)
238 struct in_addr ip_addr
;
239 char buf
[INET_ADDRSTRLEN
];
241 ip_addr
.s_addr
= htonl(addr
);
242 blobmsg_add_string(&status
, name
, inet_ntop(AF_INET
, &ip_addr
, buf
, sizeof(buf
)));
245 static void wds_to_ipv6(const char *name
, const uint16_t *addr
)
247 char buf
[INET6_ADDRSTRLEN
];
251 for (i
= 0; i
< ARRAY_SIZE(ip_addr
); i
++)
252 ip_addr
[i
] = htons(addr
[i
]);
254 blobmsg_add_string(&status
, name
, inet_ntop(AF_INET6
, &ip_addr
, buf
, sizeof(buf
)));
258 cmd_wds_get_current_settings_cb(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
)
260 void *v4
, *v6
, *d
, *t
;
261 struct qmi_wds_get_current_settings_response res
;
262 const char *pdptypes
[] = {
263 [QMI_WDS_PDP_TYPE_IPV4
] = "ipv4",
264 [QMI_WDS_PDP_TYPE_PPP
] = "ppp",
265 [QMI_WDS_PDP_TYPE_IPV6
] = "ipv6",
266 [QMI_WDS_PDP_TYPE_IPV4_OR_IPV6
] = "ipv4-or-ipv6",
268 const struct ip_modes
{
270 const QmiWdsIpFamily mode
;
272 { "ipv4", QMI_WDS_IP_FAMILY_IPV4
},
273 { "ipv6", QMI_WDS_IP_FAMILY_IPV6
},
274 { "unspecified", QMI_WDS_IP_FAMILY_UNSPECIFIED
},
278 qmi_parse_wds_get_current_settings_response(msg
, &res
);
280 t
= blobmsg_open_table(&status
, NULL
);
282 if (res
.set
.pdp_type
&& (int) res
.data
.pdp_type
< ARRAY_SIZE(pdptypes
))
283 blobmsg_add_string(&status
, "pdp-type", pdptypes
[res
.data
.pdp_type
]);
285 if (res
.set
.ip_family
) {
286 for (i
= 0; i
< ARRAY_SIZE(modes
); i
++) {
287 if (modes
[i
].mode
!= res
.data
.ip_family
)
289 blobmsg_add_string(&status
, "ip-family", modes
[i
].name
);
295 blobmsg_add_u32(&status
, "mtu", res
.data
.mtu
);
298 v4
= blobmsg_open_table(&status
, "ipv4");
300 if (res
.set
.ipv4_address
)
301 wds_to_ipv4("ip", res
.data
.ipv4_address
);
302 if (res
.set
.primary_ipv4_dns_address
)
303 wds_to_ipv4("dns1", res
.data
.primary_ipv4_dns_address
);
304 if (res
.set
.secondary_ipv4_dns_address
)
305 wds_to_ipv4("dns2", res
.data
.secondary_ipv4_dns_address
);
306 if (res
.set
.ipv4_gateway_address
)
307 wds_to_ipv4("gateway", res
.data
.ipv4_gateway_address
);
308 if (res
.set
.ipv4_gateway_subnet_mask
)
309 wds_to_ipv4("subnet", res
.data
.ipv4_gateway_subnet_mask
);
310 blobmsg_close_table(&status
, v4
);
313 v6
= blobmsg_open_table(&status
, "ipv6");
315 if (res
.set
.ipv6_address
) {
316 wds_to_ipv6("ip", res
.data
.ipv6_address
.address
);
317 blobmsg_add_u32(&status
, "ip-prefix-length", res
.data
.ipv6_address
.prefix_length
);
319 if (res
.set
.ipv6_gateway_address
) {
320 wds_to_ipv6("gateway", res
.data
.ipv6_gateway_address
.address
);
321 blobmsg_add_u32(&status
, "gw-prefix-length", res
.data
.ipv6_gateway_address
.prefix_length
);
323 if (res
.set
.ipv6_primary_dns_address
)
324 wds_to_ipv6("dns1", res
.data
.ipv6_primary_dns_address
);
325 if (res
.set
.ipv6_secondary_dns_address
)
326 wds_to_ipv6("dns2", res
.data
.ipv6_secondary_dns_address
);
328 blobmsg_close_table(&status
, v6
);
330 d
= blobmsg_open_table(&status
, "domain-names");
331 for (i
= 0; i
< res
.data
.domain_name_list_n
; i
++) {
332 blobmsg_add_string(&status
, NULL
, res
.data
.domain_name_list
[i
]);
334 blobmsg_close_table(&status
, d
);
336 blobmsg_close_table(&status
, t
);
339 static enum qmi_cmd_result
340 cmd_wds_get_current_settings_prepare(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
, char *arg
)
342 struct qmi_wds_get_current_settings_request gcs_req
;
343 memset(&gcs_req
, '\0', sizeof(struct qmi_wds_get_current_settings_request
));
344 qmi_set(&gcs_req
, requested_settings
,
345 QMI_WDS_GET_CURRENT_SETTINGS_REQUESTED_SETTINGS_PDP_TYPE
|
346 QMI_WDS_GET_CURRENT_SETTINGS_REQUESTED_SETTINGS_DNS_ADDRESS
|
347 QMI_WDS_GET_CURRENT_SETTINGS_REQUESTED_SETTINGS_GRANTED_QOS
|
348 QMI_WDS_GET_CURRENT_SETTINGS_REQUESTED_SETTINGS_IP_ADDRESS
|
349 QMI_WDS_GET_CURRENT_SETTINGS_REQUESTED_SETTINGS_GATEWAY_INFO
|
350 QMI_WDS_GET_CURRENT_SETTINGS_REQUESTED_SETTINGS_MTU
|
351 QMI_WDS_GET_CURRENT_SETTINGS_REQUESTED_SETTINGS_DOMAIN_NAME_LIST
|
352 QMI_WDS_GET_CURRENT_SETTINGS_REQUESTED_SETTINGS_IP_FAMILY
);
353 qmi_set_wds_get_current_settings_request(msg
, &gcs_req
);
354 return QMI_CMD_REQUEST
;