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;