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_set_network_preference_cb no_cb
  49 static enum qmi_cmd_result
  50 cmd_nas_set_network_preference_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, char *arg)
  51 {
  52         QmiNasGsmWcdmaAcquisitionOrderPreference pref = QMI_NAS_GSM_WCDMA_ACQUISITION_ORDER_PREFERENCE_AUTOMATIC;
  53
  54         if (!strcmp(arg, "gsm"))
  55                 pref = QMI_NAS_GSM_WCDMA_ACQUISITION_ORDER_PREFERENCE_GSM;
  56         else if (!strcmp(arg, "wcdma"))
  57                 pref = QMI_NAS_GSM_WCDMA_ACQUISITION_ORDER_PREFERENCE_WCDMA;
  58
  59         qmi_set(&sel_req, gsm_wcdma_acquisition_order_preference, pref);
  60         qmi_set_nas_set_system_selection_preference_request(msg, &sel_req);
  61         return QMI_CMD_REQUEST;
  62 }
  63
  64 #define cmd_nas_initiate_network_register_cb no_cb
  65 static enum qmi_cmd_result
  66 cmd_nas_initiate_network_register_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, char *arg)
  67 {
  68         static struct qmi_nas_initiate_network_register_request register_req;
  69         qmi_set_nas_initiate_network_register_request(msg, &register_req);
  70         return QMI_CMD_REQUEST;
  71 }
  72
  73 static void
  74 cmd_nas_get_signal_info_cb(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg)
  75 {
  76         struct qmi_nas_get_signal_info_response res;
  77
  78         qmi_parse_nas_get_signal_info_response(msg, &res);
  79
  80         if (res.set.cdma_signal_strength) {
  81                 blobmsg_add_string(&status, "type", "cdma");
  82                 blobmsg_add_u32(&status, "rssi", (int32_t) res.data.cdma_signal_strength.rssi);
  83                 blobmsg_add_u32(&status, "ecio", (int32_t) res.data.cdma_signal_strength.ecio);
  84         }
  85
  86         if (res.set.hdr_signal_strength) {
  87                 blobmsg_add_string(&status, "type", "hdr");
  88                 blobmsg_add_u32(&status, "rssi", (int32_t) res.data.hdr_signal_strength.rssi);
  89                 blobmsg_add_u32(&status, "ecio", (int32_t) res.data.hdr_signal_strength.ecio);
  90                 blobmsg_add_u32(&status, "io", res.data.hdr_signal_strength.io);
  91         }
  92
  93         if (res.set.gsm_signal_strength) {
  94                 blobmsg_add_string(&status, "type", "gsm");
  95                 blobmsg_add_u32(&status, "signal", (int32_t) res.data.gsm_signal_strength);
  96         }
  97
  98         if (res.set.wcdma_signal_strength) {
  99                 blobmsg_add_string(&status, "type", "wcdma");
 100                 blobmsg_add_u32(&status, "rssi", (int32_t) res.data.wcdma_signal_strength.rssi);
 101                 blobmsg_add_u32(&status, "ecio", (int32_t) res.data.wcdma_signal_strength.ecio);
 102         }
 103
 104         if (res.set.lte_signal_strength) {
 105                 blobmsg_add_string(&status, "type", "lte");
 106                 blobmsg_add_u32(&status, "rssi", (int32_t) res.data.lte_signal_strength.rssi);
 107                 blobmsg_add_u32(&status, "rsrq", (int32_t) res.data.lte_signal_strength.rsrq);
 108                 blobmsg_add_u32(&status, "rsrp", (int32_t) res.data.lte_signal_strength.rsrp);
 109                 blobmsg_add_u32(&status, "snr", (int32_t) res.data.lte_signal_strength.snr);
 110         }
 111 }
 112
 113 static enum qmi_cmd_result
 114 cmd_nas_get_signal_info_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, char *arg)
 115 {
 116         qmi_set_nas_get_signal_info_request(msg);
 117         return QMI_CMD_REQUEST;
 118 }
 119
 120 static void
 121 cmd_nas_get_serving_system_cb(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg)
 122 {
 123         struct qmi_nas_get_serving_system_response res;
 124         static const char *reg_states[] = {
 125                 [QMI_NAS_REGISTRATION_STATE_NOT_REGISTERED] = "not_registered",
 126                 [QMI_NAS_REGISTRATION_STATE_REGISTERED] = "registered",
 127                 [QMI_NAS_REGISTRATION_STATE_NOT_REGISTERED_SEARCHING] = "searching",
 128                 [QMI_NAS_REGISTRATION_STATE_REGISTRATION_DENIED] = "registering_denied",
 129                 [QMI_NAS_REGISTRATION_STATE_UNKNOWN] = "unknown",
 130         };
 131
 132         qmi_parse_nas_get_serving_system_response(msg, &res);
 133
 134         if (res.set.serving_system) {
 135                 int state = res.data.serving_system.registration_state;
 136
 137                 if (state > QMI_NAS_REGISTRATION_STATE_UNKNOWN)
 138                         state = QMI_NAS_REGISTRATION_STATE_UNKNOWN;
 139
 140                 blobmsg_add_string(&status, "registration", reg_states[state]);
 141         }
 142         if (res.set.current_plmn) {
 143                 blobmsg_add_u32(&status, "plmn_mcc", res.data.current_plmn.mcc);
 144                 blobmsg_add_u32(&status, "plmn_mnc", res.data.current_plmn.mnc);
 145                 if (res.data.current_plmn.description)
 146                         blobmsg_add_string(&status, "plmn_description", res.data.current_plmn.description);
 147         }
 148
 149         if (res.set.roaming_indicator)
 150                 blobmsg_add_u8(&status, "roaming", !res.data.roaming_indicator);
 151 }
 152
 153 static enum qmi_cmd_result
 154 cmd_nas_get_serving_system_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, char *arg)
 155 {
 156         qmi_set_nas_get_serving_system_request(msg);
 157         return QMI_CMD_REQUEST;
 158 }