switch.c

   1 #include "switch.h"
   2
   3 enum {
   4         DATA_MODE,
   5         DATA_MSG,
   6         DATA_INTERFACE,
   7         __DATA_MAX
   8 };
   9
  10 static void detach_driver(struct usbdev_data *data)
  11 {
  12         libusb_detach_kernel_driver(data->devh, data->interface);
  13 }
  14
  15 static void handle_generic(struct usbdev_data *data, struct blob_attr **tb)
  16 {
  17         detach_driver(data);
  18 }
  19
  20 static void handle_huawei(struct usbdev_data *data, struct blob_attr **tb)
  21 {
  22         /* TODO */
  23 }
  24
  25 static void handle_sierra(struct usbdev_data *data, struct blob_attr **tb)
  26 {
  27         /* TODO */
  28 }
  29
  30 static void handle_sony(struct usbdev_data *data, struct blob_attr **tb)
  31 {
  32         /* TODO */
  33 }
  34
  35 static void handle_qisda(struct usbdev_data *data, struct blob_attr **tb)
  36 {
  37         /* TODO */
  38 }
  39
  40 static void handle_gct(struct usbdev_data *data, struct blob_attr **tb)
  41 {
  42         detach_driver(data);
  43         /* TODO */
  44 }
  45
  46 static void handle_kobil(struct usbdev_data *data, struct blob_attr **tb)
  47 {
  48         detach_driver(data);
  49         /* TODO */
  50 }
  51
  52 static void handle_sequans(struct usbdev_data *data, struct blob_attr **tb)
  53 {
  54         /* TODO */
  55 }
  56
  57 static void handle_mobile_action(struct usbdev_data *data, struct blob_attr **tb)
  58 {
  59         /* TODO */
  60 }
  61
  62 static void handle_cisco(struct usbdev_data *data, struct blob_attr **tb)
  63 {
  64         detach_driver(data);
  65         /* TODO */
  66 }
  67
  68 enum {
  69         MODE_GENERIC,
  70         MODE_HUAWEI,
  71         MODE_SIERRA,
  72         MODE_SONY,
  73         MODE_QISDA,
  74         MODE_GCT,
  75         MODE_KOBIL,
  76         MODE_SEQUANS,
  77         MODE_MOBILE_ACTION,
  78         MODE_CISCO,
  79         __MODE_MAX
  80 };
  81
  82 static const struct {
  83         const char *name;
  84         void (*cb)(struct usbdev_data *data, struct blob_attr **tb);
  85 } modeswitch_cb[__MODE_MAX] = {
  86         [MODE_GENERIC] = { "Generic", handle_generic },
  87         [MODE_HUAWEI] = { "Huawei", handle_huawei },
  88         [MODE_SIERRA] = { "Sierra", handle_sierra },
  89         [MODE_SONY] = { "Sony", handle_sony },
  90         [MODE_QISDA] = { "Qisda", handle_qisda },
  91         [MODE_GCT] = { "GCT", handle_gct },
  92         [MODE_KOBIL] = { "Kobil", handle_kobil },
  93         [MODE_SEQUANS] = { "Sequans", handle_sequans },
  94         [MODE_MOBILE_ACTION] = { "MobileAction", handle_mobile_action },
  95         [MODE_CISCO] = { "Cisco", handle_cisco },
  96 };
  97
  98 void handle_switch(struct usbdev_data *data)
  99 {
 100         static const struct blobmsg_policy data_policy[__DATA_MAX] = {
 101                 [DATA_MODE] = { .name = "mode", .type = BLOBMSG_TYPE_STRING },
 102                 [DATA_MSG] = { .name = "msg", .type = BLOBMSG_TYPE_ARRAY },
 103                 [DATA_INTERFACE] = { .name = "interface", .type = BLOBMSG_TYPE_INT32 },
 104         };
 105         struct blob_attr *tb[__DATA_MAX];
 106         int mode = MODE_GENERIC;
 107
 108         blobmsg_parse(data_policy, __DATA_MAX, tb, blobmsg_data(data->info), blobmsg_data_len(data->info));
 109
 110         if (tb[DATA_INTERFACE])
 111                 data->interface = blobmsg_get_u32(tb[DATA_INTERFACE]);
 112
 113         if (tb[DATA_MODE]) {
 114                 const char *modestr;
 115                 int i;
 116
 117                 modestr = blobmsg_data(tb[DATA_MODE]);
 118                 for (i = 0; i < __MODE_MAX; i++) {
 119                         if (strcmp(modeswitch_cb[i].name, modestr) != 0)
 120                                 continue;
 121
 122                         mode = i;
 123                         break;
 124                 }
 125         }
 126
 127         modeswitch_cb[mode].cb(data, tb);
 128 }