add radio_state set/query support
[project/umbim.git] / cli.c
1 /*
2  * umbim
3  * Copyright (C) 2014 John Crispin <blogic@openwrt.org>
4  *
5  * This program is free software; you can redistribute it and/or modify
6  * it under the terms of the GNU General Public License version 2
7  * as published by the Free Software Foundation
8  *
9  * This program is distributed in the hope that it will be useful,
10  * but WITHOUT ANY WARRANTY; without even the implied warranty of
11  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
12  * GNU General Public License for more details.
13  */
14
15 #define __STDC_FORMAT_MACROS
16 #include <inttypes.h>
17
18 #include <sys/types.h>
19 #include <sys/stat.h>
20
21 #include <alloca.h>
22 #include <fcntl.h>
23 #include <stdio.h>
24 #include <stdlib.h>
25 #include <string.h>
26 #include <unistd.h>
27 #include <ctype.h>
28
29 #include <libubox/utils.h>
30 #include <libubox/uloop.h>
31
32 #include "mbim.h"
33
34 #include "data/mbim-service-basic-connect.h"
35
36 int return_code = -1;
37 int verbose;
38
39 struct mbim_handler *current_handler;
40 static uint8_t uuid_context_type_internet[16] = { 0x7E, 0x5E, 0x2A, 0x7E, 0x4E, 0x6F, 0x72, 0x72, 0x73, 0x6B, 0x65, 0x6E, 0x7E, 0x5E, 0x2A, 0x7E };
41 static int _argc;
42 static char **_argv;
43
44 static int
45 mbim_device_caps_response(void *buffer, int len)
46 {
47         struct mbim_basic_connect_device_caps_r *caps = (struct mbim_basic_connect_device_caps_r *) buffer;
48         char *deviceid, *firmwareinfo, *hardwareinfo;
49
50         if (len < sizeof(struct mbim_basic_connect_device_caps_r)) {
51                 fprintf(stderr, "message not long enough\n");
52                 return -1;
53         }
54
55         deviceid = mbim_get_string(&caps->deviceid, buffer);
56         firmwareinfo = mbim_get_string(&caps->firmwareinfo, buffer);
57         hardwareinfo = mbim_get_string(&caps->hardwareinfo, buffer);
58
59         printf("  devicetype: %04X - %s\n", le32toh(caps->devicetype),
60                 mbim_enum_string(mbim_device_type_values, le32toh(caps->devicetype)));
61         printf("  cellularclass: %04X\n", le32toh(caps->cellularclass));
62         printf("  voiceclass: %04X - %s\n", le32toh(caps->voiceclass),
63                 mbim_enum_string(mbim_voice_class_values, le32toh(caps->voiceclass)));
64         printf("  simclass: %04X\n", le32toh(caps->simclass));
65         printf("  dataclass: %04X\n", le32toh(caps->dataclass));
66         printf("  smscaps: %04X\n", le32toh(caps->smscaps));
67         printf("  controlcaps: %04X\n", le32toh(caps->controlcaps));
68         printf("  maxsessions: %04X\n", le32toh(caps->maxsessions));
69         printf("  deviceid: %s\n", deviceid);
70         printf("  firmwareinfo: %s\n", firmwareinfo);
71         printf("  hardwareinfo: %s\n", hardwareinfo);
72
73         return 0;
74 }
75
76 static int
77 mbim_pin_state_response(void *buffer, int len)
78 {
79         struct mbim_basic_connect_pin_r *pin = (struct mbim_basic_connect_pin_r *) buffer;
80
81         if (len < sizeof(struct mbim_basic_connect_pin_r)) {
82                 fprintf(stderr, "message not long enough\n");
83                 return -1;
84         }
85
86         if (le32toh(pin->pinstate) != MBIM_PIN_STATE_UNLOCKED) {
87                 fprintf(stderr, "required pin: %d - %s\n",
88                         le32toh(pin->pintype), mbim_enum_string(mbim_pin_type_values, le32toh(pin->pintype)));
89                 fprintf(stderr, "remaining attempts: %d\n", le32toh(pin->remainingattempts));
90                 return le32toh(pin->pintype);
91         }
92
93         fprintf(stderr, "Pin Unlocked\n");
94
95         return 0;
96 }
97
98 static int
99 mbim_registration_response(void *buffer, int len)
100 {
101         struct mbim_basic_connect_register_state_r *state = (struct mbim_basic_connect_register_state_r *) buffer;
102         char *provider_id, *provider_name, *roamingtext;
103
104         if (len < sizeof(struct mbim_basic_connect_register_state_r)) {
105                 fprintf(stderr, "message not long enough\n");
106                 return -1;
107         }
108
109         provider_id = mbim_get_string(&state->providerid, buffer);
110         provider_name = mbim_get_string(&state->providername, buffer);
111         roamingtext = mbim_get_string(&state->roamingtext, buffer);
112
113         printf("  nwerror: %04X - %s\n", le32toh(state->nwerror),
114                 mbim_enum_string(mbim_nw_error_values, le32toh(state->nwerror)));
115         printf("  registerstate: %04X - %s\n", le32toh(state->registerstate),
116                 mbim_enum_string(mbim_register_state_values, le32toh(state->registerstate)));
117         printf("  registermode: %04X - %s\n", le32toh(state->registermode),
118                 mbim_enum_string(mbim_register_mode_values, le32toh(state->registermode)));
119         printf("  availabledataclasses: %04X - %s\n", le32toh(state->availabledataclasses),
120                 mbim_enum_string(mbim_data_class_values, le32toh(state->availabledataclasses)));
121         printf("  currentcellularclass: %04X - %s\n", le32toh(state->currentcellularclass),
122                 mbim_enum_string(mbim_cellular_class_values, le32toh(state->currentcellularclass)));
123         printf("  provider_id: %s\n", provider_id);
124         printf("  provider_name: %s\n", provider_name);
125         printf("  roamingtext: %s\n", roamingtext);
126
127         if (le32toh(state->registerstate) == MBIM_REGISTER_STATE_HOME)
128                 return 0;
129
130         return le32toh(state->registerstate);
131 }
132
133 static int
134 mbim_subscriber_response(void *buffer, int len)
135 {
136         struct mbim_basic_connect_subscriber_ready_status_r *state = (struct mbim_basic_connect_subscriber_ready_status_r *) buffer;
137         char *subscriberid, *simiccid;
138         int nr;
139
140         if (len < sizeof(struct mbim_basic_connect_subscriber_ready_status_r)) {
141                 fprintf(stderr, "message not long enough\n");
142                 return -1;
143         }
144
145         subscriberid = mbim_get_string(&state->subscriberid, buffer);
146         simiccid = mbim_get_string(&state->simiccid, buffer);
147
148         printf("  readystate: %04X - %s\n", le32toh(state->readystate),
149                 mbim_enum_string(mbim_subscriber_ready_state_values, le32toh(state->readystate)));
150         printf("  simiccid: %s\n", simiccid);
151         printf("  subscriberid: %s\n", subscriberid);
152         if (le32toh(state->readyinfo) & MBIM_READY_INFO_FLAG_PROTECT_UNIQUE_ID)
153                 printf("  dont display subscriberID: 1\n");
154         for (nr = 0; nr < le32toh(state->telephonenumberscount); nr++) {
155                 struct mbim_string *str = (void *)&state->telephonenumbers + (nr * sizeof(struct mbim_string));
156                 char *number = mbim_get_string(str, buffer);
157                 printf("  number: %s\n", number);
158         }
159
160         if (MBIM_SUBSCRIBER_READY_STATE_INITIALIZED == le32toh(state->readystate))
161                 return 0;
162
163         return le32toh(state->readystate);
164 }
165
166 static int
167 mbim_attach_response(void *buffer, int len)
168 {
169         struct mbim_basic_connect_packet_service_r *ps = (struct mbim_basic_connect_packet_service_r *) buffer;
170
171         if (len < sizeof(struct mbim_basic_connect_packet_service_r)) {
172                 fprintf(stderr, "message not long enough\n");
173                 return -1;
174         }
175
176         printf("  nwerror: %04X - %s\n", le32toh(ps->nwerror),
177                 mbim_enum_string(mbim_nw_error_values, le32toh(ps->nwerror)));
178         printf("  packetservicestate: %04X - %s\n", le32toh(ps->packetservicestate),
179                 mbim_enum_string(mbim_packet_service_state_values, le32toh(ps->packetservicestate)));
180         printf("  uplinkspeed: %"PRIu64"\n", (uint64_t) le64toh(ps->uplinkspeed));
181         printf("  downlinkspeed: %"PRIu64"\n", (uint64_t) le64toh(ps->downlinkspeed));
182
183         if (MBIM_PACKET_SERVICE_STATE_ATTACHED == le32toh(ps->packetservicestate))
184                 return 0;
185
186         return le32toh(ps->packetservicestate);
187 }
188
189 static int
190 mbim_connect_response(void *buffer, int len)
191 {
192         struct mbim_basic_connect_connect_r *c = (struct mbim_basic_connect_connect_r *) buffer;
193
194         if (len < sizeof(struct mbim_basic_connect_connect_r)) {
195                 fprintf(stderr, "message not long enough\n");
196                 return -1;
197         }
198
199         printf("  sessionid: %d\n", le32toh(c->sessionid));
200         printf("  activationstate: %04X - %s\n", le32toh(c->activationstate),
201                 mbim_enum_string(mbim_activation_state_values, le32toh(c->activationstate)));
202         printf("  voicecallstate: %04X - %s\n", le32toh(c->voicecallstate),
203                 mbim_enum_string(mbim_voice_call_state_values, le32toh(c->voicecallstate)));
204         printf("  nwerror: %04X - %s\n", le32toh(c->nwerror),
205                 mbim_enum_string(mbim_nw_error_values, le32toh(c->nwerror)));
206         printf("  iptype: %04X - %s\n", le32toh(c->iptype),
207                 mbim_enum_string(mbim_context_ip_type_values, le32toh(c->iptype)));
208
209         if (MBIM_ACTIVATION_STATE_ACTIVATED == le32toh(c->activationstate))
210                 return 0;
211
212         return le32toh(c->activationstate);
213 }
214
215 static int
216 mbim_config_response(void *buffer, int len)
217 {
218         struct mbim_basic_connect_ip_configuration_r *ip = (struct mbim_basic_connect_ip_configuration_r *) buffer;
219         char out[40];
220         int i;
221         uint32_t offset;
222
223         if (len < sizeof(struct mbim_basic_connect_ip_configuration_r)) {
224                 fprintf(stderr, "message not long enough\n");
225                 return -1;
226         }
227
228         if (le32toh(ip->ipv4configurationavailable) & MBIM_IP_CONFIGURATION_AVAILABLE_FLAG_ADDRESS)
229                 for (i = 0; i < le32toh(ip->ipv4addresscount); i++) {
230                         offset = le32toh(ip->ipv4address) + (i * 4);
231                         mbim_get_ipv4(buffer, out, 4 + offset);
232                         printf("  ipv4address: %s/%d\n", out, mbim_get_int(buffer, offset));
233                 }
234         if (le32toh(ip->ipv4configurationavailable) & MBIM_IP_CONFIGURATION_AVAILABLE_FLAG_DNS) {
235                 mbim_get_ipv4(buffer, out, le32toh(ip->ipv4gateway));
236                 printf("  ipv4gateway: %s\n", out);
237         }
238         if (le32toh(ip->ipv4configurationavailable) & MBIM_IP_CONFIGURATION_AVAILABLE_FLAG_MTU)
239                 printf("  ipv4mtu: %d\n", le32toh(ip->ipv4mtu));
240         if (le32toh(ip->ipv4configurationavailable) & MBIM_IP_CONFIGURATION_AVAILABLE_FLAG_DNS)
241                 for (i = 0; i < le32toh(ip->ipv4dnsservercount); i++) {
242                         mbim_get_ipv4(buffer, out, le32toh(ip->ipv4dnsserver) + (i * 4));
243                         printf("  ipv4dnsserver: %s\n", out);
244                 }
245
246         if (le32toh(ip->ipv6configurationavailable) & MBIM_IP_CONFIGURATION_AVAILABLE_FLAG_ADDRESS)
247                 for (i = 0; i < le32toh(ip->ipv6addresscount); i++) {
248                         offset = le32toh(ip->ipv6address) + (i * 16);
249                         mbim_get_ipv6(buffer, out, 4 + offset);
250                         printf("  ipv6address: %s/%d\n", out, mbim_get_int(buffer, offset));
251                 }
252         if (le32toh(ip->ipv6configurationavailable) & MBIM_IP_CONFIGURATION_AVAILABLE_FLAG_DNS) {
253                 mbim_get_ipv6(buffer, out, le32toh(ip->ipv6gateway));
254                 printf("  ipv6gateway: %s\n", out);
255         }
256         if (le32toh(ip->ipv6configurationavailable) & MBIM_IP_CONFIGURATION_AVAILABLE_FLAG_MTU)
257                 printf("  ipv6mtu: %d\n", le32toh(ip->ipv6mtu));
258         if (le32toh(ip->ipv6configurationavailable) & MBIM_IP_CONFIGURATION_AVAILABLE_FLAG_DNS)
259                 for (i = 0; i < le32toh(ip->ipv6dnsservercount); i++) {
260                         mbim_get_ipv6(buffer, out, le32toh(ip->ipv6dnsserver) + (i * 16));
261                         printf("  ipv6dnsserver: %s\n", out);
262                 }
263
264         return 0;
265 }
266
267 static int
268 mbim_radio_response(void *buffer, int len)
269 {
270         struct mbim_basic_connect_radio_state_r *r = (struct mbim_basic_connect_radio_state_r *) buffer;
271
272         if (len < sizeof(struct mbim_basic_connect_radio_state_r)) {
273                 fprintf(stderr, "message not long enough\n");
274                 return -1;
275         }
276         printf("  hwradiostate: %s\n", r->hwradiostate ? "on" : "off");
277         printf("  swradiostate: %s\n", r->swradiostate ? "on" : "off");
278         return 0;
279 }
280
281 static int
282 mbim_device_caps_request(void)
283 {
284         mbim_setup_command_msg(basic_connect, MBIM_MESSAGE_COMMAND_TYPE_QUERY, MBIM_CMD_BASIC_CONNECT_DEVICE_CAPS, 0);
285
286         return mbim_send_command_msg();
287 }
288
289 static int
290 mbim_pin_state_request(void)
291 {
292         mbim_setup_command_msg(basic_connect, MBIM_MESSAGE_COMMAND_TYPE_QUERY, MBIM_CMD_BASIC_CONNECT_PIN, 0);
293
294         return mbim_send_command_msg();
295 }
296
297 static int
298 mbim_registration_request(void)
299 {
300         mbim_setup_command_msg(basic_connect, MBIM_MESSAGE_COMMAND_TYPE_QUERY, MBIM_CMD_BASIC_CONNECT_REGISTER_STATE, 0);
301
302         return mbim_send_command_msg();
303 }
304
305 static int
306 mbim_subscriber_request(void)
307 {
308         mbim_setup_command_msg(basic_connect, MBIM_MESSAGE_COMMAND_TYPE_QUERY, MBIM_CMD_BASIC_CONNECT_SUBSCRIBER_READY_STATUS, 0);
309
310         return mbim_send_command_msg();
311 }
312
313 static int
314 _mbim_attach_request(int action)
315 {
316         struct mbim_basic_connect_packet_service_s *ps =
317                 (struct mbim_basic_connect_packet_service_s *) mbim_setup_command_msg(basic_connect,
318                         MBIM_MESSAGE_COMMAND_TYPE_SET, MBIM_CMD_BASIC_CONNECT_PACKET_SERVICE,
319                         sizeof(struct mbim_basic_connect_packet_service_s));
320
321         ps->packetserviceaction = htole32(action);
322
323         return mbim_send_command_msg();
324 }
325
326 static int
327 mbim_attach_request(void)
328 {
329         return _mbim_attach_request(MBIM_PACKET_SERVICE_ACTION_ATTACH);
330 }
331
332 static int
333 mbim_detach_request(void)
334 {
335         return _mbim_attach_request(MBIM_PACKET_SERVICE_ACTION_DETACH);
336 }
337
338 static int
339 mbim_connect_request(void)
340 {
341         char *apn;
342         struct mbim_basic_connect_connect_s *c =
343                 (struct mbim_basic_connect_connect_s *) mbim_setup_command_msg(basic_connect,
344                         MBIM_MESSAGE_COMMAND_TYPE_SET, MBIM_CMD_BASIC_CONNECT_CONNECT,
345                         sizeof(struct mbim_basic_connect_connect_s));
346
347         c->activationcommand = htole32(MBIM_ACTIVATION_COMMAND_ACTIVATE);
348         c->iptype = htole32(MBIM_CONTEXT_IP_TYPE_DEFAULT);
349         memcpy(c->contexttype, uuid_context_type_internet, 16);
350         if (_argc > 0) {
351                 apn = index(*_argv, ':');
352                 if (!apn) {
353                         apn = *_argv;
354                 } else {
355                         apn[0] = 0;
356                         apn++;
357                         if (!strcmp(*_argv, "ipv4"))
358                                 c->iptype = htole32(MBIM_CONTEXT_IP_TYPE_IPV4);
359                         else if (!strcmp(*_argv, "ipv6"))
360                                 c->iptype = htole32(MBIM_CONTEXT_IP_TYPE_IPV6);
361                         else if (!strcmp(*_argv, "ipv4v6"))
362                                 c->iptype = htole32(MBIM_CONTEXT_IP_TYPE_IPV4V6);
363                 }
364                 mbim_encode_string(&c->accessstring, apn);
365         }
366         if (_argc > 3) {
367                 if (!strcmp(_argv[1], "pap"))
368                         c->authprotocol = htole32(MBIM_AUTH_PROTOCOL_PAP);
369                 else if (!strcmp(_argv[1], "chap"))
370                         c->authprotocol = htole32(MBIM_AUTH_PROTOCOL_CHAP);
371                 else if (!strcmp(_argv[1], "mschapv2"))
372                         c->authprotocol = htole32(MBIM_AUTH_PROTOCOL_MSCHAPV2);
373
374                 if (c->authprotocol) {
375                         mbim_encode_string(&c->username, _argv[2]);
376                         mbim_encode_string(&c->password, _argv[3]);
377                 }
378         }
379         return mbim_send_command_msg();
380 }
381
382 static int
383 mbim_disconnect_request(void)
384 {
385         struct mbim_basic_connect_connect_s *c =
386                 (struct mbim_basic_connect_connect_s *) mbim_setup_command_msg(basic_connect,
387                         MBIM_MESSAGE_COMMAND_TYPE_SET, MBIM_CMD_BASIC_CONNECT_CONNECT,
388                         sizeof(struct mbim_basic_connect_connect_s));
389
390         c->activationcommand = htole32(MBIM_ACTIVATION_COMMAND_DEACTIVATE);
391         memcpy(c->contexttype, uuid_context_type_internet, 16);
392
393         no_close = 0;
394
395         return mbim_send_command_msg();
396 }
397
398 static char*
399 mbim_pin_sanitize(char *pin)
400 {
401         char *p;
402
403         while (*pin && !isdigit(*pin))
404                 pin++;
405         p = pin;
406         if (!*p)
407                 return NULL;
408         while (*pin && isdigit(*pin))
409                 pin++;
410         if (*pin)
411                 *pin = '\0';
412
413         return p;
414 }
415
416 static int
417 mbim_pin_unlock_request(void)
418 {
419         struct mbim_basic_connect_pin_s *p =
420                 (struct mbim_basic_connect_pin_s *) mbim_setup_command_msg(basic_connect,
421                         MBIM_MESSAGE_COMMAND_TYPE_SET, MBIM_CMD_BASIC_CONNECT_PIN,
422                         sizeof(struct mbim_basic_connect_pin_s));
423         char *pin = mbim_pin_sanitize(_argv[0]);
424
425         if (!pin || !strlen(pin)) {
426                 fprintf(stderr, "failed to sanitize the pincode\n");
427                 return -1;
428         }
429
430         p->pintype = htole32(MBIM_PIN_TYPE_PIN1);
431         p->pinoperation = htole32(MBIM_PIN_OPERATION_ENTER);
432         mbim_encode_string(&p->pin, _argv[0]);
433
434         return mbim_send_command_msg();
435 }
436
437 static int
438 mbim_config_request(void)
439 {
440         mbim_setup_command_msg(basic_connect,
441                 MBIM_MESSAGE_COMMAND_TYPE_QUERY, MBIM_CMD_BASIC_CONNECT_IP_CONFIGURATION,
442                 sizeof(struct mbim_basic_connect_ip_configuration_q));
443
444         return mbim_send_command_msg();
445 }
446
447 static int
448 mbim_radio_request(void)
449 {
450         if (_argc > 0) {
451                 struct mbim_basic_connect_radio_state_s *rs =
452                         (struct mbim_basic_connect_radio_state_s *) mbim_setup_command_msg(basic_connect,
453                                 MBIM_MESSAGE_COMMAND_TYPE_SET, MBIM_CMD_BASIC_CONNECT_RADIO_STATE,
454                                 sizeof(struct mbim_basic_connect_radio_state_r));
455
456                 if (!strcmp(_argv[0], "off"))
457                         rs->radiostate = htole32(MBIM_RADIO_SWITCH_STATE_OFF);
458                 else
459                         rs->radiostate = htole32(MBIM_RADIO_SWITCH_STATE_ON);
460         } else {
461                 mbim_setup_command_msg(basic_connect,
462                         MBIM_MESSAGE_COMMAND_TYPE_QUERY, MBIM_CMD_BASIC_CONNECT_RADIO_STATE,
463                         sizeof(struct mbim_basic_connect_radio_state_r));
464         }
465         return mbim_send_command_msg();
466 }
467
468 static struct mbim_handler handlers[] = {
469         { "caps", 0, mbim_device_caps_request, mbim_device_caps_response },
470         { "pinstate", 0, mbim_pin_state_request, mbim_pin_state_response },
471         { "unlock", 1, mbim_pin_unlock_request, mbim_pin_state_response },
472         { "registration", 0, mbim_registration_request, mbim_registration_response },
473         { "subscriber", 0, mbim_subscriber_request, mbim_subscriber_response },
474         { "attach", 0, mbim_attach_request, mbim_attach_response },
475         { "detach", 0, mbim_detach_request, mbim_attach_response },
476         { "connect", 0, mbim_connect_request, mbim_connect_response },
477         { "disconnect", 0, mbim_disconnect_request, mbim_connect_response },
478         { "config", 0, mbim_config_request, mbim_config_response },
479         { "radio", 0, mbim_radio_request, mbim_radio_response },
480 };
481
482 static int
483 usage(void)
484 {
485         fprintf(stderr, "Usage: umbim <caps|pinstate|unlock|registration|subscriber|attach|detach|connect|disconnect|config|radio> [options]\n"
486                 "Options:\n"
487                 "    -d <device>        the device (/dev/cdc-wdmX)\n"
488                 "    -t <transaction>   the transaction id\n"
489                 "    -n                 no close\n\n"
490                 "    -v                 verbose\n\n");
491         return 1;
492 }
493
494 int
495 main(int argc, char **argv)
496 {
497         char *cmd, *device = NULL;
498         int no_open = 0, ch, i;
499
500         while ((ch = getopt(argc, argv, "nvd:t:")) != -1) {
501                 switch (ch) {
502                 case 'v':
503                         verbose = 1;
504                         break;
505                 case 'n':
506                         no_close = 1;
507                         break;
508                 case 'd':
509                         device = optarg;
510                         break;
511                 case 't':
512                         no_open = 1;
513                         transaction_id = atoi(optarg);
514                         break;
515                 default:
516                         return usage();
517                 }
518         }
519
520         if (!device || optind == argc)
521                 return usage();
522
523         cmd = argv[optind];
524         optind++;
525
526         _argc = argc - optind;
527         _argv = &argv[optind];
528
529         for (i = 0; i < ARRAY_SIZE(handlers); i++)
530                 if (!strcmp(cmd, handlers[i].name))
531                         current_handler = &handlers[i];
532
533         if (!current_handler || (optind + current_handler->argc > argc))
534                 return usage();
535
536         uloop_init();
537
538         mbim_open(device);
539         if (!no_open)
540                 mbim_send_open_msg();
541         else if (current_handler->request() < 0)
542                 return -1;
543
544         uloop_run();
545         uloop_done();
546
547         return return_code;
548 }