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_auth_cb no_cb
34 static enum qmi_cmd_result
35 cmd_wds_set_auth_prepare(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
, char *arg
)
39 QmiWdsAuthentication auth
;
41 { "pap", QMI_WDS_AUTHENTICATION_PAP
},
42 { "chap", QMI_WDS_AUTHENTICATION_CHAP
},
43 { "both", QMI_WDS_AUTHENTICATION_PAP
| QMI_WDS_AUTHENTICATION_CHAP
},
44 { "none", QMI_WDS_AUTHENTICATION_NONE
},
48 for (i
= 0; i
< ARRAY_SIZE(modes
); i
++) {
49 if (strcasecmp(modes
[i
].name
, arg
) != 0)
52 qmi_set(&wds_sn_req
, authentication_preference
, modes
[i
].auth
);
56 uqmi_add_error("Invalid auth mode (valid: pap, chap, both, none)");
60 #define cmd_wds_set_username_cb no_cb
61 static enum qmi_cmd_result
62 cmd_wds_set_username_prepare(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
, char *arg
)
64 qmi_set_ptr(&wds_sn_req
, username
, arg
);
68 #define cmd_wds_set_password_cb no_cb
69 static enum qmi_cmd_result
70 cmd_wds_set_password_prepare(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
, char *arg
)
72 qmi_set_ptr(&wds_sn_req
, password
, arg
);
76 #define cmd_wds_set_autoconnect_cb no_cb
77 static enum qmi_cmd_result
78 cmd_wds_set_autoconnect_prepare(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
, char *arg
)
80 qmi_set(&wds_sn_req
, enable_autoconnect
, true);
81 qmi_set(&wds_stn_req
, disable_autoconnect
, true);
85 #define cmd_wds_set_ip_family_pref_cb no_cb
86 static enum qmi_cmd_result
87 cmd_wds_set_ip_family_pref_prepare(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
, char *arg
)
91 const QmiWdsIpFamily mode
;
93 { "ipv4", QMI_WDS_IP_FAMILY_IPV4
},
94 { "ipv6", QMI_WDS_IP_FAMILY_IPV6
},
95 { "unspecified", QMI_WDS_IP_FAMILY_UNSPECIFIED
},
99 for (i
= 0; i
< ARRAY_SIZE(modes
); i
++) {
100 if (strcasecmp(modes
[i
].name
, arg
) != 0)
103 qmi_set(&wds_sn_req
, ip_family_preference
, modes
[i
].mode
);
107 uqmi_add_error("Invalid value (valid: ipv4, ipv6, unspecified)");
112 cmd_wds_start_network_cb(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
)
114 struct qmi_wds_start_network_response res
;
116 qmi_parse_wds_start_network_response(msg
, &res
);
117 if (res
.set
.packet_data_handle
)
118 blobmsg_add_u32(&status
, NULL
, res
.data
.packet_data_handle
);
121 static enum qmi_cmd_result
122 cmd_wds_start_network_prepare(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
, char *arg
)
124 qmi_set_ptr(&wds_sn_req
, apn
, arg
);
125 qmi_set_wds_start_network_request(msg
, &wds_sn_req
);
126 return QMI_CMD_REQUEST
;
129 #define cmd_wds_stop_network_cb no_cb
130 static enum qmi_cmd_result
131 cmd_wds_stop_network_prepare(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
, char *arg
)
133 uint32_t pdh
= strtoul(arg
, NULL
, 0);
135 qmi_set(&wds_stn_req
, packet_data_handle
, pdh
);
136 qmi_set_wds_stop_network_request(msg
, &wds_stn_req
);
137 return QMI_CMD_REQUEST
;
141 cmd_wds_get_packet_service_status_cb(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
)
143 struct qmi_wds_get_packet_service_status_response res
;
144 const char *data_status
[] = {
145 [QMI_WDS_CONNECTION_STATUS_UNKNOWN
] = "unknown",
146 [QMI_WDS_CONNECTION_STATUS_DISCONNECTED
] = "disconnected",
147 [QMI_WDS_CONNECTION_STATUS_CONNECTED
] = "connected",
148 [QMI_WDS_CONNECTION_STATUS_SUSPENDED
] = "suspended",
149 [QMI_WDS_CONNECTION_STATUS_AUTHENTICATING
] = "authenticating",
153 qmi_parse_wds_get_packet_service_status_response(msg
, &res
);
154 if (res
.set
.connection_status
&&
155 res
.data
.connection_status
< ARRAY_SIZE(data_status
))
156 s
= res
.data
.connection_status
;
158 blobmsg_add_string(&status
, NULL
, data_status
[s
]);
161 static enum qmi_cmd_result
162 cmd_wds_get_packet_service_status_prepare(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
, char *arg
)
164 qmi_set_wds_get_packet_service_status_request(msg
);
165 return QMI_CMD_REQUEST
;
168 #define cmd_wds_set_autoconnect_setting_cb no_cb
169 static enum qmi_cmd_result
170 cmd_wds_set_autoconnect_setting_prepare(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
, char *arg
)
172 struct qmi_wds_set_autoconnect_setting_request ac_req
;
173 const char *modes
[] = {
174 [QMI_WDS_AUTOCONNECT_DISABLED
] = "disabled",
175 [QMI_WDS_AUTOCONNECT_ENABLED
] = "enabled",
176 [QMI_WDS_AUTOCONNECT_PAUSED
] = "paused",
180 for (i
= 0; i
< ARRAY_SIZE(modes
); i
++) {
181 if (strcasecmp(modes
[i
], arg
) != 0)
184 qmi_set(&ac_req
, setting
, i
);
185 qmi_set_wds_set_autoconnect_setting_request(msg
, &ac_req
);
189 uqmi_add_error("Invalid value (valid: disabled, enabled, paused)");
193 #define cmd_wds_reset_cb no_cb
194 static enum qmi_cmd_result
195 cmd_wds_reset_prepare(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
, char *arg
)
197 qmi_set_wds_reset_request(msg
);
198 return QMI_CMD_REQUEST
;
201 #define cmd_wds_set_ip_family_cb no_cb
202 static enum qmi_cmd_result
203 cmd_wds_set_ip_family_prepare(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
, char *arg
)
205 struct qmi_wds_set_ip_family_request ipf_req
;
206 const struct ip_modes
{
208 const QmiWdsIpFamily mode
;
210 { "ipv4", QMI_WDS_IP_FAMILY_IPV4
},
211 { "ipv6", QMI_WDS_IP_FAMILY_IPV6
},
212 { "unspecified", QMI_WDS_IP_FAMILY_UNSPECIFIED
},
216 for (i
= 0; i
< ARRAY_SIZE(modes
); i
++) {
217 if (strcasecmp(modes
[i
].name
, arg
) != 0)
220 qmi_set(&ipf_req
, preference
, modes
[i
].mode
);
221 qmi_set_wds_set_ip_family_request(msg
, &ipf_req
);
222 return QMI_CMD_REQUEST
;
225 uqmi_add_error("Invalid value (valid: ipv4, ipv6, unspecified)");
229 static void wds_to_ipv4(const char *name
, const uint32_t addr
)
231 struct in_addr ip_addr
;
232 char buf
[INET_ADDRSTRLEN
];
234 ip_addr
.s_addr
= htonl(addr
);
235 blobmsg_add_string(&status
, name
, inet_ntop(AF_INET
, &ip_addr
, buf
, sizeof(buf
)));
238 static void wds_to_ipv6(const char *name
, const uint16_t *addr
)
240 char buf
[INET6_ADDRSTRLEN
];
244 for (i
= 0; i
< ARRAY_SIZE(ip_addr
); i
++)
245 ip_addr
[i
] = htons(addr
[i
]);
247 blobmsg_add_string(&status
, name
, inet_ntop(AF_INET6
, &ip_addr
, buf
, sizeof(buf
)));
251 cmd_wds_get_current_settings_cb(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
)
253 void *v4
, *v6
, *d
, *t
;
254 struct qmi_wds_get_current_settings_response res
;
255 const char *pdptypes
[] = {
256 [QMI_WDS_PDP_TYPE_IPV4
] = "ipv4",
257 [QMI_WDS_PDP_TYPE_PPP
] = "ppp",
258 [QMI_WDS_PDP_TYPE_IPV6
] = "ipv6",
259 [QMI_WDS_PDP_TYPE_IPV4_OR_IPV6
] = "ipv4-or-ipv6",
261 const struct ip_modes
{
263 const QmiWdsIpFamily mode
;
265 { "ipv4", QMI_WDS_IP_FAMILY_IPV4
},
266 { "ipv6", QMI_WDS_IP_FAMILY_IPV6
},
267 { "unspecified", QMI_WDS_IP_FAMILY_UNSPECIFIED
},
271 qmi_parse_wds_get_current_settings_response(msg
, &res
);
273 t
= blobmsg_open_table(&status
, NULL
);
275 if (res
.set
.pdp_type
&& (int) res
.data
.pdp_type
< ARRAY_SIZE(pdptypes
))
276 blobmsg_add_string(&status
, "pdp-type", pdptypes
[res
.data
.pdp_type
]);
278 if (res
.set
.ip_family
) {
279 for (i
= 0; i
< ARRAY_SIZE(modes
); i
++) {
280 if (modes
[i
].mode
!= res
.data
.ip_family
)
282 blobmsg_add_string(&status
, "ip-family", modes
[i
].name
);
288 blobmsg_add_u32(&status
, "mtu", res
.data
.mtu
);
291 v4
= blobmsg_open_table(&status
, "ipv4");
293 if (res
.set
.ipv4_address
)
294 wds_to_ipv4("ip", res
.data
.ipv4_address
);
295 if (res
.set
.primary_ipv4_dns_address
)
296 wds_to_ipv4("dns1", res
.data
.primary_ipv4_dns_address
);
297 if (res
.set
.secondary_ipv4_dns_address
)
298 wds_to_ipv4("dns2", res
.data
.secondary_ipv4_dns_address
);
299 if (res
.set
.ipv4_gateway_address
)
300 wds_to_ipv4("gateway", res
.data
.ipv4_gateway_address
);
301 if (res
.set
.ipv4_gateway_subnet_mask
)
302 wds_to_ipv4("subnet", res
.data
.ipv4_gateway_subnet_mask
);
303 blobmsg_close_table(&status
, v4
);
306 v6
= blobmsg_open_table(&status
, "ipv6");
308 if (res
.set
.ipv6_address
) {
309 wds_to_ipv6("ip", res
.data
.ipv6_address
.address
);
310 blobmsg_add_u32(&status
, "ip-prefix-length", res
.data
.ipv6_address
.prefix_length
);
312 if (res
.set
.ipv6_gateway_address
) {
313 wds_to_ipv6("gateway", res
.data
.ipv6_gateway_address
.address
);
314 blobmsg_add_u32(&status
, "gw-prefix-length", res
.data
.ipv6_gateway_address
.prefix_length
);
316 if (res
.set
.ipv6_primary_dns_address
)
317 wds_to_ipv6("dns1", res
.data
.ipv6_primary_dns_address
);
318 if (res
.set
.ipv6_secondary_dns_address
)
319 wds_to_ipv6("dns2", res
.data
.ipv6_secondary_dns_address
);
321 blobmsg_close_table(&status
, v6
);
323 d
= blobmsg_open_table(&status
, "domain-names");
324 for (i
= 0; i
< res
.data
.domain_name_list_n
; i
++) {
325 blobmsg_add_string(&status
, NULL
, res
.data
.domain_name_list
[i
]);
327 blobmsg_close_table(&status
, d
);
329 blobmsg_close_table(&status
, t
);
332 static enum qmi_cmd_result
333 cmd_wds_get_current_settings_prepare(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
, char *arg
)
335 struct qmi_wds_get_current_settings_request gcs_req
;
336 memset(&gcs_req
, '\0', sizeof(struct qmi_wds_get_current_settings_request
));
337 qmi_set(&gcs_req
, requested_settings
,
338 QMI_WDS_GET_CURRENT_SETTINGS_REQUESTED_SETTINGS_PDP_TYPE
|
339 QMI_WDS_GET_CURRENT_SETTINGS_REQUESTED_SETTINGS_DNS_ADDRESS
|
340 QMI_WDS_GET_CURRENT_SETTINGS_REQUESTED_SETTINGS_GRANTED_QOS
|
341 QMI_WDS_GET_CURRENT_SETTINGS_REQUESTED_SETTINGS_IP_ADDRESS
|
342 QMI_WDS_GET_CURRENT_SETTINGS_REQUESTED_SETTINGS_GATEWAY_INFO
|
343 QMI_WDS_GET_CURRENT_SETTINGS_REQUESTED_SETTINGS_MTU
|
344 QMI_WDS_GET_CURRENT_SETTINGS_REQUESTED_SETTINGS_DOMAIN_NAME_LIST
|
345 QMI_WDS_GET_CURRENT_SETTINGS_REQUESTED_SETTINGS_IP_FAMILY
);
346 qmi_set_wds_get_current_settings_request(msg
, &gcs_req
);
347 return QMI_CMD_REQUEST
;