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 ipv4[16];
 220         int i;
 221
 222         if (len < sizeof(struct mbim_basic_connect_ip_configuration_r)) {
 223                 fprintf(stderr, "message not long enough\n");
 224                 return -1;
 225         }
 226
 227         if (le32toh(ip->ipv4configurationavailable) & MBIM_IP_CONFIGURATION_AVAILABLE_FLAG_ADDRESS)
 228                 for (i = 0; i < le32toh(ip->ipv4addresscount); i++) {
 229                         mbim_get_ipv4(buffer, ipv4, ip->ipv4address + (i * 4));
 230                         printf("  ipv4address: %s\n", ipv4);
 231                 }
 232         if (le32toh(ip->ipv4configurationavailable) & MBIM_IP_CONFIGURATION_AVAILABLE_FLAG_DNS) {
 233                 mbim_get_ipv4(buffer, ipv4, ip->ipv4gateway);
 234                 printf("  ipv4gateway: %s\n", ipv4);
 235         }
 236         if (le32toh(ip->ipv4configurationavailable) & MBIM_IP_CONFIGURATION_AVAILABLE_FLAG_MTU)
 237                 printf("  ipv4mtu: %d\n", le32toh(ip->ipv4mtu));
 238         if (le32toh(ip->ipv4configurationavailable) & MBIM_IP_CONFIGURATION_AVAILABLE_FLAG_DNS)
 239                 for (i = 0; i < le32toh(ip->ipv4dnsservercount); i++) {
 240                         mbim_get_ipv4(buffer, ipv4, ip->ipv4dnsserver + (i * 4));
 241                         printf("  ipv4dnsserver: %s\n", ipv4);
 242                 }
 243
 244         printf("  ipv6configurationavailable: %04X\n", le32toh(ip->ipv6configurationavailable));
 245
 246         return 0;
 247 }
 248
 249 static int
 250 mbim_device_caps_request(void)
 251 {
 252         mbim_setup_command_msg(basic_connect, MBIM_MESSAGE_COMMAND_TYPE_QUERY, MBIM_CMD_BASIC_CONNECT_DEVICE_CAPS, 0);
 253
 254         return mbim_send_command_msg();
 255 }
 256
 257 static int
 258 mbim_pin_state_request(void)
 259 {
 260         mbim_setup_command_msg(basic_connect, MBIM_MESSAGE_COMMAND_TYPE_QUERY, MBIM_CMD_BASIC_CONNECT_PIN, 0);
 261
 262         return mbim_send_command_msg();
 263 }
 264
 265 static int
 266 mbim_registration_request(void)
 267 {
 268         mbim_setup_command_msg(basic_connect, MBIM_MESSAGE_COMMAND_TYPE_QUERY, MBIM_CMD_BASIC_CONNECT_REGISTER_STATE, 0);
 269
 270         return mbim_send_command_msg();
 271 }
 272
 273 static int
 274 mbim_subscriber_request(void)
 275 {
 276         mbim_setup_command_msg(basic_connect, MBIM_MESSAGE_COMMAND_TYPE_QUERY, MBIM_CMD_BASIC_CONNECT_SUBSCRIBER_READY_STATUS, 0);
 277
 278         return mbim_send_command_msg();
 279 }
 280
 281 static int
 282 _mbim_attach_request(int action)
 283 {
 284         struct mbim_basic_connect_packet_service_s *ps =
 285                 (struct mbim_basic_connect_packet_service_s *) mbim_setup_command_msg(basic_connect,
 286                         MBIM_MESSAGE_COMMAND_TYPE_SET, MBIM_CMD_BASIC_CONNECT_PACKET_SERVICE,
 287                         sizeof(struct mbim_basic_connect_packet_service_s));
 288
 289         ps->packetserviceaction = htole32(action);
 290
 291         return mbim_send_command_msg();
 292 }
 293
 294 static int
 295 mbim_attach_request(void)
 296 {
 297         return _mbim_attach_request(MBIM_PACKET_SERVICE_ACTION_ATTACH);
 298 }
 299
 300 static int
 301 mbim_detach_request(void)
 302 {
 303         return _mbim_attach_request(MBIM_PACKET_SERVICE_ACTION_DETACH);
 304 }
 305
 306 static int
 307 mbim_connect_request(void)
 308 {
 309         struct mbim_basic_connect_connect_s *c =
 310                 (struct mbim_basic_connect_connect_s *) mbim_setup_command_msg(basic_connect,
 311                         MBIM_MESSAGE_COMMAND_TYPE_SET, MBIM_CMD_BASIC_CONNECT_CONNECT,
 312                         sizeof(struct mbim_basic_connect_connect_s));
 313
 314         c->activationcommand = htole32(MBIM_ACTIVATION_COMMAND_ACTIVATE);
 315         c->iptype = htole32(MBIM_CONTEXT_IP_TYPE_DEFAULT);
 316         memcpy(c->contexttype, uuid_context_type_internet, 16);
 317         if (_argc > 0)
 318                 mbim_encode_string(&c->accessstring, *_argv);
 319         if (_argc > 3) {
 320                 if (!strcmp(_argv[1], "pap"))
 321                         c->authprotocol = htole32(MBIM_AUTH_PROTOCOL_PAP);
 322                 else if (!strcmp(_argv[1], "chap"))
 323                         c->authprotocol = htole32(MBIM_AUTH_PROTOCOL_CHAP);
 324                 else if (!strcmp(_argv[1], "mschapv2"))
 325                         c->authprotocol = htole32(MBIM_AUTH_PROTOCOL_MSCHAPV2);
 326
 327                 if (c->authprotocol) {
 328                         mbim_encode_string(&c->username, _argv[2]);
 329                         mbim_encode_string(&c->password, _argv[3]);
 330                 }
 331         }
 332         return mbim_send_command_msg();
 333 }
 334
 335 static int
 336 mbim_disconnect_request(void)
 337 {
 338         struct mbim_basic_connect_connect_s *c =
 339                 (struct mbim_basic_connect_connect_s *) mbim_setup_command_msg(basic_connect,
 340                         MBIM_MESSAGE_COMMAND_TYPE_SET, MBIM_CMD_BASIC_CONNECT_CONNECT,
 341                         sizeof(struct mbim_basic_connect_connect_s));
 342
 343         c->activationcommand = htole32(MBIM_ACTIVATION_COMMAND_DEACTIVATE);
 344         memcpy(c->contexttype, uuid_context_type_internet, 16);
 345
 346         no_close = 0;
 347
 348         return mbim_send_command_msg();
 349 }
 350
 351 static char*
 352 mbim_pin_sanitize(char *pin)
 353 {
 354         char *p;
 355
 356         while (*pin && !isdigit(*pin))
 357                 pin++;
 358         p = pin;
 359         if (!*p)
 360                 return NULL;
 361         while (*pin && isdigit(*pin))
 362                 pin++;
 363         if (*pin)
 364                 *pin = '\0';
 365
 366         return p;
 367 }
 368
 369 static int
 370 mbim_pin_unlock_request(void)
 371 {
 372         struct mbim_basic_connect_pin_s *p =
 373                 (struct mbim_basic_connect_pin_s *) mbim_setup_command_msg(basic_connect,
 374                         MBIM_MESSAGE_COMMAND_TYPE_SET, MBIM_CMD_BASIC_CONNECT_PIN,
 375                         sizeof(struct mbim_basic_connect_pin_s));
 376         char *pin = mbim_pin_sanitize(_argv[0]);
 377
 378         if (!pin || !strlen(pin)) {
 379                 fprintf(stderr, "failed to sanitize the pincode\n");
 380                 return -1;
 381         }
 382
 383         p->pintype = htole32(MBIM_PIN_TYPE_PIN1);
 384         p->pinoperation = htole32(MBIM_PIN_OPERATION_ENTER);
 385         mbim_encode_string(&p->pin, _argv[0]);
 386
 387         return mbim_send_command_msg();
 388 }
 389
 390 static int
 391 mbim_config_request(void)
 392 {
 393         mbim_setup_command_msg(basic_connect,
 394                 MBIM_MESSAGE_COMMAND_TYPE_QUERY, MBIM_CMD_BASIC_CONNECT_IP_CONFIGURATION,
 395                 sizeof(struct mbim_basic_connect_ip_configuration_q));
 396
 397         return mbim_send_command_msg();
 398 }
 399
 400 static struct mbim_handler handlers[] = {
 401         { "caps", 0, mbim_device_caps_request, mbim_device_caps_response },
 402         { "pinstate", 0, mbim_pin_state_request, mbim_pin_state_response },
 403         { "unlock", 1, mbim_pin_unlock_request, mbim_pin_state_response },
 404         { "registration", 0, mbim_registration_request, mbim_registration_response },
 405         { "subscriber", 0, mbim_subscriber_request, mbim_subscriber_response },
 406         { "attach", 0, mbim_attach_request, mbim_attach_response },
 407         { "detach", 0, mbim_detach_request, mbim_attach_response },
 408         { "connect", 0, mbim_connect_request, mbim_connect_response },
 409         { "disconnect", 0, mbim_disconnect_request, mbim_connect_response },
 410         { "config", 0, mbim_config_request, mbim_config_response },
 411 };
 412
 413 static int
 414 usage(void)
 415 {
 416         fprintf(stderr, "Usage: mbim <caps|pinstate|unlock|connect|disconnect> [options]\n"
 417                 "Options:\n"
 418                 "    -d <device>        the device (/dev/cdc-wdmX)\n"
 419                 "    -t <transaction>   the transaction id\n"
 420                 "    -n                 no close\n\n"
 421                 "    -v                 verbose\n\n");
 422         return 1;
 423 }
 424
 425 int
 426 main(int argc, char **argv)
 427 {
 428         char *cmd, *device = NULL;
 429         int no_open = 0, ch, i;
 430
 431         while ((ch = getopt(argc, argv, "nvd:t:")) != -1) {
 432                 switch (ch) {
 433                 case 'v':
 434                         verbose = 1;
 435                         break;
 436                 case 'n':
 437                         no_close = 1;
 438                         break;
 439                 case 'd':
 440                         device = optarg;
 441                         break;
 442                 case 't':
 443                         no_open = 1;
 444                         transaction_id = atoi(optarg);
 445                         break;
 446                 default:
 447                         return usage();
 448                 }
 449         }
 450
 451         if (!device || optind == argc)
 452                 return usage();
 453
 454         cmd = argv[optind];
 455         optind++;
 456
 457         _argc = argc - optind;
 458         _argv = &argv[optind];
 459
 460         for (i = 0; i < ARRAY_SIZE(handlers); i++)
 461                 if (!strcmp(cmd, handlers[i].name))
 462                         current_handler = &handlers[i];
 463
 464         if (!current_handler || (optind + current_handler->argc > argc))
 465                 return usage();
 466
 467         uloop_init();
 468
 469         mbim_open(device);
 470         if (!no_open)
 471                 mbim_send_open_msg();
 472         else if (current_handler->request() < 0)
 473                 return -1;
 474
 475         uloop_run();
 476         uloop_done();
 477
 478         return return_code;
 479 }