commands-nas.c

   1 #include "qmi-message.h"
   2
   3 static struct qmi_nas_set_system_selection_preference_request sel_req;
   4
   5 #define cmd_nas_set_network_modes_cb no_cb
   6 static enum qmi_cmd_result
   7 cmd_nas_set_network_modes_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, char *arg)
   8 {
   9         static const struct {
  10                 const char *name;
  11                 QmiNasRatModePreference val;
  12         } modes[] = {
  13                 { "cdma", QMI_NAS_RAT_MODE_PREFERENCE_CDMA_1X | QMI_NAS_RAT_MODE_PREFERENCE_CDMA_1XEVDO },
  14                 { "td-scdma", QMI_NAS_RAT_MODE_PREFERENCE_TD_SCDMA },
  15                 { "gsm", QMI_NAS_RAT_MODE_PREFERENCE_GSM },
  16                 { "umts", QMI_NAS_RAT_MODE_PREFERENCE_UMTS },
  17                 { "lte", QMI_NAS_RAT_MODE_PREFERENCE_LTE },
  18         };
  19         QmiNasRatModePreference val = 0;
  20         char *word;
  21         int i;
  22
  23         for (word = strtok(arg, ",");
  24              word;
  25              word = strtok(NULL, ",")) {
  26                 bool found = false;
  27
  28                 for (i = 0; i < ARRAY_SIZE(modes); i++) {
  29                         if (strcmp(word, modes[i].name) != 0 &&
  30                                 strcmp(word, "all") != 0)
  31                                 continue;
  32
  33                         val |= modes[i].val;
  34                         found = true;
  35                 }
  36
  37                 if (!found) {
  38                         blobmsg_add_string(&status, "error", "Invalid network mode");
  39                         return QMI_CMD_EXIT;
  40                 }
  41         }
  42
  43         qmi_set(&sel_req, mode_preference, val);
  44         qmi_set_nas_set_system_selection_preference_request(msg, &sel_req);
  45         return QMI_CMD_REQUEST;
  46 }
  47
  48 #define cmd_nas_initiate_network_register_cb no_cb
  49 static enum qmi_cmd_result
  50 cmd_nas_initiate_network_register_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, char *arg)
  51 {
  52         static struct qmi_nas_initiate_network_register_request register_req;
  53         qmi_set_nas_initiate_network_register_request(msg, &register_req);
  54         return QMI_CMD_REQUEST;
  55 }
  56
  57 static void
  58 cmd_nas_get_signal_info_cb(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg)
  59 {
  60         struct qmi_nas_get_signal_info_response res;
  61
  62         qmi_parse_nas_get_signal_info_response(msg, &res);
  63
  64         if (res.set.cdma_signal_strength) {
  65                 blobmsg_add_string(&status, "type", "cdma");
  66                 blobmsg_add_u32(&status, "rssi", (int32_t) res.data.cdma_signal_strength.rssi);
  67                 blobmsg_add_u32(&status, "ecio", (int32_t) res.data.cdma_signal_strength.ecio);
  68         }
  69
  70         if (res.set.hdr_signal_strength) {
  71                 blobmsg_add_string(&status, "type", "hdr");
  72                 blobmsg_add_u32(&status, "rssi", (int32_t) res.data.hdr_signal_strength.rssi);
  73                 blobmsg_add_u32(&status, "ecio", (int32_t) res.data.hdr_signal_strength.ecio);
  74                 blobmsg_add_u32(&status, "io", res.data.hdr_signal_strength.io);
  75         }
  76
  77         if (res.set.gsm_signal_strength) {
  78                 blobmsg_add_string(&status, "type", "gsm");
  79                 blobmsg_add_u32(&status, "signal", (int32_t) res.data.gsm_signal_strength);
  80         }
  81
  82         if (res.set.wcdma_signal_strength) {
  83                 blobmsg_add_string(&status, "type", "wcdma");
  84                 blobmsg_add_u32(&status, "rssi", (int32_t) res.data.wcdma_signal_strength.rssi);
  85                 blobmsg_add_u32(&status, "ecio", (int32_t) res.data.wcdma_signal_strength.ecio);
  86         }
  87
  88         if (res.set.lte_signal_strength) {
  89                 blobmsg_add_string(&status, "type", "lte");
  90                 blobmsg_add_u32(&status, "rssi", (int32_t) res.data.lte_signal_strength.rssi);
  91                 blobmsg_add_u32(&status, "rsrq", (int32_t) res.data.lte_signal_strength.rsrq);
  92                 blobmsg_add_u32(&status, "rsrp", (int32_t) res.data.lte_signal_strength.rsrp);
  93                 blobmsg_add_u32(&status, "snr", (int32_t) res.data.lte_signal_strength.snr);
  94         }
  95 }
  96
  97 static enum qmi_cmd_result
  98 cmd_nas_get_signal_info_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, char *arg)
  99 {
 100         qmi_set_nas_get_signal_info_request(msg);
 101         return QMI_CMD_REQUEST;
 102 }
 103
 104 static void
 105 cmd_nas_get_serving_system_cb(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg)
 106 {
 107         struct qmi_nas_get_serving_system_response res;
 108         static const char *reg_states[] = {
 109                 [QMI_NAS_REGISTRATION_STATE_NOT_REGISTERED] = "not_registered",
 110                 [QMI_NAS_REGISTRATION_STATE_REGISTERED] = "registered",
 111                 [QMI_NAS_REGISTRATION_STATE_NOT_REGISTERED_SEARCHING] = "searching",
 112                 [QMI_NAS_REGISTRATION_STATE_REGISTRATION_DENIED] = "registering_denied",
 113                 [QMI_NAS_REGISTRATION_STATE_UNKNOWN] = "unknown",
 114         };
 115
 116         qmi_parse_nas_get_serving_system_response(msg, &res);
 117
 118         if (res.set.serving_system) {
 119                 int state = res.data.serving_system.registration_state;
 120
 121                 if (state > QMI_NAS_REGISTRATION_STATE_UNKNOWN)
 122                         state = QMI_NAS_REGISTRATION_STATE_UNKNOWN;
 123
 124                 blobmsg_add_string(&status, "registration", reg_states[state]);
 125         }
 126         if (res.set.current_plmn) {
 127                 blobmsg_add_u32(&status, "plmn_mcc", res.data.current_plmn.mcc);
 128                 blobmsg_add_u32(&status, "plmn_mnc", res.data.current_plmn.mnc);
 129                 if (res.data.current_plmn.description)
 130                         blobmsg_add_string(&status, "plmn_description", res.data.current_plmn.description);
 131         }
 132
 133         if (res.set.roaming_indicator)
 134                 blobmsg_add_u8(&status, "roaming", !res.data.roaming_indicator);
 135 }
 136
 137 static enum qmi_cmd_result
 138 cmd_nas_get_serving_system_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, char *arg)
 139 {
 140         qmi_set_nas_get_serving_system_request(msg);
 141         return QMI_CMD_REQUEST;
 142 }